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人 工 心理 的 重要 技术 基础 与 应 用 领域 之 一 是 市 
器 情感 密切 相关 的 家 用 机 器 人 和 教育 
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器 人 学 科 与 技术 。 龙 其 是 与 人 工 知 能 和 机 
竞赛 机 器 人 是 教育 机 器 人 的 一 种 重要 形式 ， 是 














青少年 学 习 掌 握 机 器 人 技术 的 一 种 主要 途径 ， 它 主要 涉及 人 工 智 能 、 计 算 机 控制 、 传 感 器 技 


术 和 竞技 技术 。 如 何 更 好 、 更 容易 地 说 
法 ， 由 浅 入 深 地 向 读者 传授 机 器 人 技术 ， 是 我 




















上 青少年 学 习 掌 握 这 门 技术 ， 尤 其 是 通过 实验 制作 的 方 
门 撰写 本 书 的 主要 目的 。 








本 书 以 大 学 生 、 研 究 生 为 读者 对 象 ， 详 细 讲 述 竞赛 机 器 人 相关 技术 与 方法 。 全 书 共 分 为 
8 章 。 第 1 章 主要 介绍 各 种 竞赛 机 器 人 的 各 种 功能 以 及 其 国内 外 赛事 ; 第 2 章 主要 介绍 竞赛 














机 器 人 的 控制 器 技术 ; 第 3 章 介绍 一 种 竞赛 机 器 人 软件 开发 平台 
法 ; 第 4 章 介绍 竞赛 机 器 人 





EF 全 的 整体 结构 设 i 























MPLABIDE 的 使 用 方 


十 ; 第 5 章 介绍 竞赛 机 器 人 平台 的 硬件 电路 设 





计 与 制作 ; 第 6 章 介 绍 竞赛 机 器 人 软件 模块 的 编程 方法 ; 第 7 章 介绍 竞赛 机 器 人 的 控制 方 


法 ; 第 8 章 介绍 了 机 器 人 工程 化 应 用 实例 。 
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1.1 机 器 人 概述 


机 器 人 一 词 最 早出 现 于 1920 年 捷克 作家 Karel Capek 的 剧本 《 罗 萨 姆 的 万 能 机 器 人 》 
中 ， 在 该 剧 中 “Robota” 这 个 词 的 本 意 是 苦力 ， 是 剧 作家 笔下 的 一 个 具有 人 的 外 表 、 特 征 和 
功能 的 机 器 ， 是 一 种 人 造 的 劳动 力 。 我 国 采 用 的 是 意译 ， 实 际 机 器 人 的 外 形 大 多 很 少 与 人 有 
相似 之 处 。 

机 器 人 一 词 的 出 现 和 第 一 台 工 业 机 器 人 的 问世 都 是 近 几 十 年 的 事 。 然 而 人 们 对 机 器 人 的 
幻想 与 追求 却 已 有 3000 多 年 的 历史 。 人 类 希望 制造 一 种 像 人 一 样 的 机 器 ， 以 便 代替 人 类 完 
成 各 种 工作 。 西 周 时 期 ， 我 国 的 能 工 巧 匠 优 师 就 研制 出 了 能 歌 善 舞 的 机 器 一 一 伶 人 ， 这 是 我 
国 最 早 记载 的 机 器 人 。 后 汉 三 国 时 期 ， 唱 国 和 丞相 诸 葛 亮 成 功 地 创造 出 了 “ 木 牛 流 马 ”， 并 用 
其 运送 军粮 ， 支 援 前 方 战争 。 公 元 前 2 世纪 ， 亚 历 山大 时 代 的 古 希 腊 人 发 明了 最 原始 的 机 器 
人 一 一 自动 机 ， 它 是 以 水 、 空 气 和 蒸汽 压力 为 动力 的 会 动 的 对 像 ， 它 可 以 自己 开门 ， 还 可 以 
EDRU ÍK 

现代 机 器 人 的 研究 始 于 20 世纪 中 期 ， 其 技术 背景 是 计算 机 和 自动 化 技术 的 发 展 ， 以 及 
核能 的 开发 利用 。 自 1946 年 第 一 台数 字 电 子 计 算 机 问世 以 来 ， 计 算 机 技术 取得 了 惊人 的 进 
步 ， 向 高 速度 、 大 容量 、 低 价格 的 方向 发 展 。 大 批量 生产 的 迫切 需求 推动 了 自动 化 技术 的 进 
展 ， 其 结果 之 一 便 是 1952 年 数控 机 床 的 诞生 。 与 数控 机 床 相关 的 控制 、 机 械 零 件 的 研究 又 
为 机 器 人 的 开发 商定 了 基础 。 另 一 方面 ， 核 能 实验 室 的 恶劣 环境 要 求 用 某 些 操作 机 械 代替 人 
处 理 放射 性 物质 。 在 这 一 需求 背景 下 ， 美 国 原 子 能 委员 会 的 阿尔 贡 研究 所 于 1947 年 开发 了 
遥控 机 械 手 ，1948 年 又 开发 了 机 械 式 的 主 从 机 械 手 。 

1954 年 美国 戴 沃 尔 最 早 提出 了 工业 机 器 人 的 概念 ， 并 申请 了 专利 。 该 专利 的 要 点 是 借 
助 伺服 技术 控制 机 器 人 的 关节 ， 利 用 人 手 对 机 器 人 进行 动作 示 教 ， 机 器 人 能 实现 动作 的 记录 
和 再 现 。 这 就 是 所 谓 的 示 教 再 现 机 器 人 。 现 有 的 机 器 人 差不多 都 采用 这 种 控制 方式 。 

作为 机 器 人 产品 最 早 的 实用 机 型 ( 示 教 再 现 ) 是 1962 年 美国 AMP 公司 推出 的 “VER- 
STRAN” 和 UNIMATION 公司 推出 的 “UNIMATE”。 这 些 工业 机 器 人 的 控制 方式 与 数控 机 床 
大 致 相似 ， 但 外 形 特征 过 异 ， 主 要 由 类 似 人 的 手 和 臂 组 成 。1965 年 ，MIT (美国 麻 省 理工 学 
BE) 的 Robots 演示 了 第 一 个 具有 视觉 传感器 的 、 能 识别 与 定位 的 、 简 单 积 木 的 机 器 人 系统 。 

1973 年 ， 瑞 典 的 ABB 与 德国 的 KUKA 分 别 将 各 自 研 发 的 最 新 一 代 工 业 机 器 人 推 向 市 
協 ,IRB6 是 ABB 公司 设计 研发 的 世界 上 第 一 款 微 处 理 器 控制 的 全 电动 工业 机 器 人 ; 而 
KUKA 推 出 的 第 一 代 自 主 研 发 机 器 人 FAMULUS 拥有 多 达 6 个 驱动 轴 来 完成 复杂 机 械 动 作 " 。 

如 今 机 器 人 发 展 的 特点 可 概括 为 : 从 横向 看 ， 应 用 面 越 来 越 宽 ， 由 95% 的 工业 应 用 扩 
展 到 更 多 领域 的 非 工业 应 用 ， 像 做 手术 、 采 摘 水 果 、 剪 枝 、 埠 道 掘进 、 侦 查 、 排 雷 ， 还 有 空 
间 机 器 人 、 潜 海 机 器 人 ; 从 纵向 看 ， 机 器 人 的 种 类 会 越 来 越 多 ， 像 进入 人 体 的 微型 机 器 人 ， 
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已 成 为 一 个 新 方向 ， 可 以 小 到 像 一 个 米粒 般 大 小 。 最 重要 的 是 机 器 人 智能 化 得 到 加 强 ， 机 需 
人 会 更 加 聪明 。 具 有 感知 能 力 和 思维 能 力 的 机 器 人 是 我 们 追求 的 目标 。 归 纳 起 来 ， 机 器 人 的 
发 展 除了 受到 人 们 想象 力 的 限制 外 ， 还 受到 计算 机 技术 、 传 感 技术 、 材 料 的 限制 。 

反 过 来 ， 机 器 人 的 发 展 促进 相关 技术 的 进步 。 从 1959 年 第 一 台 机 器 人 诞生 到 20 世纪 80 
年 代 初 ， 机 器 人 技术 经 历 了 一 个 长 期 缓慢 的 发 展 过 程 。 到 了 90 年 代 ， 随 着 计算 机 技术 、 微 
电子 技术 、 网 络 技 术 等 的 快速 发 展 ， 机 器 人 技术 也 得 到 了 飞速 发 展 。 除 了 工业 机 器 人 水 平 不 
断 提 高 之 外 ， 各 种 用 于 非 制 造 业 的 先进 机 器 人 系统 也 有 了 长 足 的 进展 。 

现代 机 器 人 在 处 理 器 、 远 程控 制 与 通信 、 信 息 采 集 系 统 、 自 动 化 设备 等 方面 都 有 了 显著 
的 提升 。 同 时 ， 现 代 机 器 人 的 研发 重心 也 在 从 工业 机 器 人 向 服务 型 机 器 人 转移 ， 服 务 型 机 器 
人 的 成 本 相对 更 低 ， 受 众 面 也 更 广 ， 随 着 人 们 对 居家 生活 质量 越 来 越 高 的 要 求 ， 服 务 型 机 器 
人 走 人 和 干 家 万 户 已 成 为 机 器 人 产业 的 新 趋势 。 

随 着 计算 机 技术 和 人 工 智能 技术 的 飞速 发 展 ， 使 机 器 人 在 功能 和 技术 层次 上 有 了 很 大 的 
提高 ， 移 动机 器 人 和 机 器 人 的 视觉 和 触觉 等 技术 就 是 典型 的 代表 。 由 于 这 些 技术 的 发 展 ， 推 
动 了 机 器 人 概念 的 延伸 。20 世纪 80 年 代 , 将 具有 感觉 、 思 考 、 决 策 和 动作 能 力 的 系统 称 为 
智能 机 器 人 ， 这 是 一 个 概括 的 、 含 义 广 泛 的 概念 。 这 一 概念 不 但 指导 了 机 器 人 技术 的 研究 和 
应 用 ， 而 且 又 赋予 了 机 器 人 技术 向 次 广发 展 的 巨大 空间 ， 水 下 机 器 人 、 空 间 机 器 人 、 空 中 机 
器 人 、 地 面 机 器 人 、 微 小 型 机 器 人 等 各 种 用 途 的 机 器 人 相继 问世 ， 许 多 梦想 成 为 了 现实 。 将 
机 需 人 的 技术 〈 如 传 感 技术 、 智 能 技术 、 控 制 技术 等 ) 扩散 和 渗透 到 各 个 领域 ,形成 了 各 
式 各 样 的 新 机 絮 一 一 机 器 人 化 机 器 。 当 前 与 信息 技术 的 交互 和 融合 又 产生 了 “软件 机 絮 人 ” 
“网 络 机 器 人 ”的 名 称 ， 这 也 说 明了 机 器 人 所 具有 的 创新 活力 。 


1.2 竞赛 机 器 人 的 国际 赛事 


在 世界 科技 和 经 济 大 发 展 的 情况 下 ， 为 了 普及 机 右 人 知识 ,促进 机 器 人 技术 的 研究 发 
展 ， 世 界 上 很 多 国家 和 地 区 纷纷 开展 了 各 种 类 型 的 机 器 人 比赛 。 机 器 人 比赛 除了 需要 采用 比 
较 先 进 的 技术 外 ， 还 有 几 个 特点 : 一 是 对 抗 性 强 ， 比 赛 时 间 短 ， 有 很 强 的 观赏 性 ， 二 是 能 够 
充分 地 发 挥 参赛 者 的 创造 性 思维 ; 三 是 比赛 策略 和 临场 发 挥 非常 重要 ; 四 是 比赛 规则 和 题目 
变化 较 大 。 

目前 , 日本、 美国 、 英 国 等 发 达 国 家 的 机 器 人 竞赛 发 展 很 快 。 在 这 些 国 家 ， 从 小 学 生 到 
大 学 生 ， 从 学 校 到 社会 ， 都 有 各 种 不 同 的 机 器 人 比赛 ， 日 本 每 年 都 有 很 多 机 器 人 比赛 ， 如 走 
迷宫 机 器 人 比赛 (老鼠 机 器 人 ) 、 寻 白 线 机 器 人 、 大 学 生机 器 人 大 赛 。 在 英国 有 : ROBOT 
WARS, techno games， 全 民 参 加 比赛 ， 政 府 监督 ， 电 视 台 主办 ， 形 成 了 较为 完整 的 机 器 人 竞 
赛 体系 。 因 为 有 了 这 样 的 比赛 ， 人 们 更 加 了 解 机 器 人 ， 机 器 人 的 发 展 也 得 到 很 大 的 促进 。 

下 面 就 简要 介绍 一 下 国际 上 比较 有 名 的 机 器 人 竞赛 : RoboCup 竞赛 、FIRACup 竞赛 、 迷 
宫 机 器 人 竞赛 、 寻 线 机 器 人 兖 赛 、 迷 宣 操 作 机 器 人 竞赛 、 灭 火 机 器 人 竞赛 、 舞 蹈 机 器 人 况 
赛 、 相 扑 机 器 人 竞赛 等 。 


1.2.1 RoboCup 比赛 
RoboCup (Robot World Cup ， 机 器 人 世界 杯 ) 比赛 的 前 身 是 日 本 机 器 人 足球 赛 ， 是 由 日 
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本 的 北野 宏明 和 浅 田 者 等 学者 千 1993 年 6 月 发 起 创办 的 。 它 是 通过 提供 足球 比赛 这 样 一 个 
标准 问题 来 促进 人 工 智能 、 机 器 人 以 及 相关 领域 的 研究 而 建立 的 国际 组 织 。 其 最 终 目标 是 经 
过 50 年 左右 的 研究 ， 使 机 器 人 足球 队 能 战胜 人 类 足球 冠军 队 。 

1997 年 8 月 23 日 ， 首 届 机 器 人 足球 世界 杯赛 在 日 本 名 古 屋 举行 ,来 自 美国 、 日 本 、 欧 
洲 和 澳洲 的 40 多 支 机 器 人 足球 队 参 加 了 比赛 。 众 多 国际 知名 学 府 成 为 RoboCup 的 首 批 参赛 
者 。 在 举办 第 一 届 RoboCup 的 同时 ，1997 国际 人 工 智 能 联合 大 会 (JCAI97) 也 在 名 古 屋 举 
行 ， 在 这 之 后 ，1999 年 和 2003 年 ，RoboCup 和 ICAL 都 在 同时 同 地 举办 ， 这 也 无 疑 表 明了 
RoboCup 在 人 工 智 能 界 的 地 位 。 图 1-1 所 示 为 足球 机 器 人 比赛 的 两 幅 图 片 。 











Les robots jouent leur coupe gu monde de foot 
し j = 1 ur 











图 1-1 足球 机 器 人 比赛 





RoboCup 至 今 已 举办 了 18 JH, 目前 RoboCup 的 活动 包括 有 : 技术 会 议 、 机 器 人 比赛 、 
挑战 计划 、 教 育 计 划 、 基 础 发 展 等 ， 而 机 器 人 比赛 是 所 有 活动 的 核心 。 目 前 机 器 人 比赛 的 类 
型 包括 : 

(1) 足球 比赛 (RoboCupSoccer ) 

仿真 组 (Simulation Team) ; 

小 型 组 (Small Size Team ) ; 

中 型 组 (Middle Size Team) ; 

四 腿 组 (Sony Legged Team) ; 

类 人 组 (Humanoid League ) 。 

(2) 营救 比赛 (RoboCupRescue ) 

仿真 组 (Rescue Simulation Team) ; 

机 器 组 (Rescue Robot Team) 。 

(3) 青少年 比赛 (RoboCupJunior ) 

JEERBLAS A. (Soccer Challenge ) ; 

舞蹈 机 器 人 (Dance Challenge) 。 

RoboCup 以 其 独特 的 魅力 ， 成 为 各 类 国际 机 器 人 竞赛 中 最 具 水 平和 影响 力 的 赛事 之 一 。 
许多 世界 名 校 包 括 美国 卡耐基 - 梅 隆 大 学 、 康 奈 尔 大 学 、 斯 坦 福 大 学 ， 澳 大 利 亚 新 南 威 尔 士 
K, 日 本 东京 大 学 ， 新 加 坡 南洋 理工 大 学 ， 和 荷兰 阿姆斯特丹 大 学 ,德国 多 特 索 德 大 学 以 及 
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中 国 的 清华 大 学 、 中 国 科技 大 学 等 都 积极 参与 。 由 机 器 人 联合 会 组 织 的 1999 E E Lait 
人 世界 杯 足 球赛 于 8 月 4~8 日 在 巴西 的 坎 皮 那 斯 举行 。 东 北大 学 的 “牛牛 ” 队 代表 我 国 参 
加 了 比赛 ， 并 取得 了 3 对 3 对 抗 赛 的 第 五 名 和 标准 动作 比赛 的 第 一 名 的 好 成 绩 ， 为 祖国 争 得 
TARE > FPA RoboCup 足球 赛 及 学 术 大 会 于 2000 年 8 月 25 日 ~9 月 3 日 在 澳大利亚 墨 尔 
本 举行 。 来 自 约 30 个 国家 的 154 支 球 队 参 加 了 预选 ， 约 100 SERASI TEREZ, 在 40 
文 球 队 参 赛 的 仿真 组 比赛 中 ， 中 国 科技 大 学 “ 蓝 座 ” 队 攻 入 20 个 球 ,，“ 蓝 座 ” 队 是 第 一 文 
进入 RoboCup 的 中 国 球 队 。 最 近 两 年 的 仿真 组 八 强 中 , 来 自 中 国 的 球 队 在 RoboCup 比赛 中 
表现 突出 ， 清 华 风 神 队 更 是 连续 夺 得 两 次 冠军 和 一 次 亚军 。 


1.2.2 FIRACup 比赛 


FIRA 微机 器 人 足球 比赛 最 早 是 由 韩国 高 等 技术 研究 院 (Korea Advanced Institute of Sci- 
ence and Technology, KAIST) 的 金 钟 焕 (Jong-Hwan Kim) 教授 于 1995 年 提出 ， 并 于 1996 
年 在 KAIST 所 在 的 韩国 大 田 (Daejeon) 举办 了 第 一 届 国 际 比赛 。1997 年 6 月 ， 第 二 届 微 机 
器 人 足球 比赛 (MiroSot97 ) 在 KAIST 举行 期 间 ， 国 际 机 器 人 足球 联盟 (Federation of Interna- 
tional Robot-soccer Association, FIRA) 宣告 成 立 。 此 后 FIRA 在 全 球 范 围 内 每 年 举行 一 次 国 
际 机 器 人 足球 联盟 杯 (FIRA Cup) 比赛 ， 同 时 举办 学 术 会 议 (FIRA Congress) ， 供 参赛 者 交 
流 他 们 在 机 器 人 足球 研究 方面 的 经 验 和 技术 ， 这 成 为 了 FIRA 的 惯例 。 

JE FIRA 比赛 莲 勃 开展 的 同时 ， 有 关机 器 人 足球 系统 和 机 器 人 足球 比赛 的 理论 研究 也 取 
得 了 长 足 进展 。 每 一 届 世 界 杯 比 赛 之 前 ， 主 办 者 都 会 举行 培训 和 研讨 班 ， 并 在 比赛 举行 的 同 
时 召开 机 器 人 足球 专题 的 国际 学 术 会 议 ， 这 些 论 文集 中 介绍 了 与 机 器 人 足球 相关 的 视觉 系 
统 、 运 动 规划 、 动 作 设 计 、 策 略 选 择 等 领域 的 最 新 研究 成 果 。 这 些 学 术 研 讨 和 交流 活动 ， 极 
大 地 促进 了 相关 学 科 的 理论 研究 。 

理论 研究 的 成 果 使 得 机 器 人 足球 比赛 的 水 平 不 断 提 高 。 在 1996 年 的 第 一 届 MiroSot 比赛 
中 ， 大 多 数 参赛 队 使 用 的 视觉 系统 的 采集 /处 理 速度 仅 为 10 帧 /<s， 机 器 人 速度 也 不 过 50cm/ 
so IWE, KAEH Keys 队 ， 和 凭借 他 们 高 达 60 次 /s 的 视频 采集 /处 理 速度 和 机 器 人 
2m/s 的 运动 速度 ， 在 法 国 巴 黎 举 行 的 FIRA'98 世界 锦标 赛 中 一 举 夺 技 ， 其 足球 机 器 人 的 表 
现 让 人 惊叹 不 已 。 这 些 进步 得 益 于 电子 和 计算 机 技术 的 发 展 带 来 的 硬件 性 能 的 飞速 提高 。 

男 一 方面 ， 有 关 足 球 机 器 人 动作 和 策略 的 研究 也 成 绩 显著 。 早 先 的 比赛 当中 ， 机 融 人 之 
间 缺 乏 合理 的 分 工 协作 ， 很 容易 挤 作 一 团 。 现 在 这 种 现象 已 不 存在 ， 随 着 策略 研究 的 不 断 成 
熟 ， 比 赛 的 精彩 程度 也 在 不 断 增加 。MiroSot 机 器 人 的 设计 制造 技术 取得 重大 的 进展 ， 随 着 
新 的 单片机 技术 的 发 展 ， 机 器 人 的 控制 更 加 可 靠 ， 运动 速度 成 倍增 加 ， 同 时 也 形成 了 共 轴 两 
轮 独 立 驱 动 这 种 一 直 延 续 至 今 的 小 车 布局 。 足 球 机 器 人 如 图 1-2 所 示 。 


1.2.3 迷宫 机 器 人 比赛 


第 一 次 参赛 的 迷宫 机 器 人 (MicroMouse) 是 机 械 的 。1972 年 ，《 Machine Design) 奈 志 
发 起 了 一 场 比赛 ， 用 弹簧 做 动力 的 迷宫 机 器 人 沿 着 跑道 ， 比 拼 毅 力 ， 看 谁 跑 的 最 远 。 最 后 获 
得 第 一 名 的 迷宫 机 器 人 跑 了 251. 6m (825. 3ft) 。 

迷宮 机 器 人 (MicroMouse) 是 一 种 小 型 自主 探测 迷宫 的 机 器 人 。1977 年 ，IEEE (美国 
电气 与 电子 工程 师 学 会 ) AP Spectrum 杂志 提议 并 在 世界 范围 内 征集 MicroMouse 比赛 ， 参 
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赛 的 迷宫 机 器 人 应 在 规定 的 迷宫 区 域内 看 谁 最 快 地 识别 并 走出 迷宫 。 在 1977 年 5 H, Spec- 
trum 宣布 第 一 届 美 国 迷宫 机 器 人 苋 完 于 1979 年 6 月 在 纽约 举行 。 





















图 12 足球 机 器 人 


1978 年 夏 ，6000 只 迷宫 机 器 人 在 美国 经 历 了 三 轮 比赛 ， 其 中 的 15 只 迷宫 机 器 人 一 路 过 
关 斩 将 ， 于 1979 年 最 终 获得 参加 NCC (全 美 计算 机 会 议 ) 纽约 年 会 决赛 的 资格 。 结 果 Bol- 
land and Dikkeknback 的 “月 光 号 迷宫 机 器 人 ”以 全 程 29.78s 的 成 绩 夺 冠 。 此 后 ， 此 项 赛事 
在 一 片 父 奖 声 中 一 发 不 可 收拾 。 

最 著名 的 迷宫 机 器 人 是 : Nick Smith’s Sterling Mouse 、Alan Dibley’s Mitee Mouse I and 
Mitee Mouse II , Dave Otten’ s Mitee Mouse I and Mitee Mouse [I] ， 如 图 1-3 所 示 。 








MicroMouse Lab A MicroMouse Robot Dave Otten ’s Mitee Mouse 


图 1-3 最 著名 的 迷宫 机 器 人 


1980 年 ， 欧 洲 各 国 效仿 美国 ， 每 年 在 Euromicro (欧洲 微型 计算 机 学 会 ) 年 会 会 场 举办 
类 似 的 比赛 。1980 年 ， 欧 洲 人 在 伦敦 举行 了 第 一 届 欧 洲 迷 宫 机 器 人 大 赛 ，18 个 迷宫 机 器 人 
都 没有 到 达 终 点 。 从 日 本 科学 基金 会 派 去 的 参观 者 把 竞赛 规则 带 回 了 东京 ， 并 举办 了 第 一 届 
全 日 本 迷宫 机 器 人 竞赛 。 

1985 年 8 月 ,来 自 全 欧洲 和 美国 的 迷宫 机 器 人 参加 了 在 东京 举行 的 第 一 届 址 界 迷 宫 机 
器 人 竞赛 。 所 用 的 传感器 有 红外 线 传感器 、 超 声波 传 感 咒 、 电 向 耦合 器 件 〈《CCD) fee ait 
等 。 了 驱动 装置 有 步 进 电动 机 、 直 流 伺服 电动 机 。 日 本 的 Noriko-1 队 包 揽 了 所 有 的 比赛 奖牌 。 
日 本 从 1980 年 开始 举办 全 日 本 的 机 器 鼠 比 赛 ， 每 年 有 大 约 100 台 机 器 鼠 参 加 比赛 ， 是 知名 
度 较 高 、 基 础 雄厚 、 普 及 性 较 广 的 一 项 赛事 。 迷 富 机 器 人 比赛 分 三 个 项 目 : FERRE PAR 
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操作 。 

从 第 13 届 日 本 机 器 人 比赛 开始 设置 操作 项 目 ， 任 务 是 将 迷宫 路 径 上 事先 放置 的 圆 馈 反 
转 倒置 ， 在 规定 的 时 间 内 倒置 的 圆 缸 越 多 ， 得 分 越 多 。 为 此 ， 机 器 人 需要 加 强 作业 功能 ， 如 
装备 探测 圆 链 、 翻 转 倒置 圆 饶 的 手 抓 等 。 

机 器 人 走 迷 宫 比 赛 是 要 求 机 器 人 从 比赛 场地 中 的 起 始 区 出 发 ， 在 规定 的 时 间 内 ， 寻 找 最 
好 的 路 线 走出 迷宫 ， 一 般 比 赛 是 以 机 器 人 的 俯视 中 心 离开 迷宫 场地 为 准 。 这 就 要 求 不 论 迷 富 
形式 怎样 变化 ， 机 器 人 都 能 通过 不 断 探 测 找到 终点 。 一 般 机 器 人 由 行走 机 构 、 导 向 及 障 但 控 
测 需 、 控 制 系统 组 成 。 它 由 蓄电池 供电 ， 可 完成 前 进 、 后 退 、 斜 行 、 横 移 、 转 膏 等 动作 。 机 
器 人 穿越 迷宫 的 整个 过 程 ， 展 示 了 全 方位 行走 和 路 线 识别 技术 。 

迷宫 机 器 人 一 旦 起 动 ， 必 须 在 没有 参赛 选手 的 干预 下 自动 控制 ， 机 器 人 必须 是 由 计算 机 
程序 控制 ， 而 非 人 工 现场 控制 。 机 器 人 在 运行 过 程 中 可 以 碰撞 或 接触 墙壁 ， 但 是 不 能 故意 标 
记 和 破坏 墙壁 。 机 器 人 经 过 比赛 场地 时 不 能 把 任何 东西 留 在 后 面 ， 并 且 不 能 在 比赛 场地 留 下 
任何 可 以 帮助 它 运行 的 标记 。 如 果 裁 判 认 为 机 器 人 故意 破坏 了 比赛 场地 (包括 墙壁 )， 该 机 
器 人 将 被 取消 参赛 成 绩 或 资格 。 


1.2.4 和 寻 线 机 器 人 比赛 


从 第 7 届 迷 宫 机 器 人 比赛 开始 设立 寻 线 比赛 项 目 。 迷 富 机 器 人 在 黑 底 色 比 赛场 地 上 巡 着 
白色 条 带 标志 路 线 行进 〈 从 第 13 届 起 ， 路 径 可 实时 改变 ) ， 条 带宽 度 为 1. 9em， 路 线 由 若干 
直线 和 圆 弧 形成 的 复杂 曲线 ， 可 以 近似 直角 地 连接 或 交叉 ， 如 图 14 所 示 。 所 有 的 圆 弧 曲 率 
半径 大 于 30cm， 在 曲线 拐点 处 也 有 标志 ， 且 将 其 邻近 长 Im、 宽 0.4m 的 区 域 划分 为 出 发 
区 。 迷 宫 机 絮 人 的 尺寸 限制 在 25cm x 25em x20cm 〈 长 x 宽 x 高 ) 内 , 重量 不 限 。 在 起 点 ， 
允许 在 3min 的 限定 时 间 内 环绕 场地 试 走 3 圈 ， 每 圈 终 了 必须 在 出 发 区 内 自动 停车 后 再 起 动 。 
因此 ， 可 以 在 环绕 策略 上 进行 规划 。 比 如 第 一 圈 控 测 直 线 曲线 、 熟 悉 和 记忆 场地 等 。 第 二 图 
尝试 和 选择 加 减速 度 的 合适 数值 、 改 变 战 略 等 。 第 三 圈 应 当 全 速 前 进 。 寻 线 一 周 所 用 时 间 最 
短 的 机 器 人 获胜 。 比 赛 路 线 每 年 变动 ， 机 器 人 需要 在 现场 徘 标 志 物 的 特征 实时 识别 路 线 ， 因 
此 对 机 器 人 的 智能 有 一 定 的 要 求 。 





























图 14 寻 线 机 器 人 及 场地 


1.2.5 RANAMA 

灭火 机 器 人 需要 主动 寻找 晴 烛 火焰 ， 它 可 以 运用 类 似 水 、 空 气 、CO, 、Halon 〈 哈 龙 
一 一 属于 讽 代 烷 的 化 学 品 ， 主 要 用 于 灭火 ) 等 物质 ， 或 者 使 用 机 械 方式 扑灭 蜡烛 火焰 ， 但 
是 禁止 使 用 任何 危险 的 或 可 能 破坏 比赛 场地 的 方法 或 物质 。 比 如 ， 不 能 通过 燃放 爆竹 产生 冲 
击 波 来 使 晴 烛 熄 灭 ， 也 不 能 通过 碰 倒 晴 烛 而 使 晴 烛 熄 灭 。 晴 烛 在 燃烧 状态 时 不 允许 被 撞 倒 。 
如 果 机 器 人 在 灭火 过 程 中 碰撞 蜡烛 ， 机 器 人 的 运行 仍然 有 效 。 如 果 蜡 烛 被 撞 倒 ， 按 未 完成 灭 
火 任务 处 理 。 机 器 人 扑灭 蜡烛 的 过 程 中 所 产生 的 杂 物 ， 例 如 水 、 发 酵 粉 、 生 奶油 等 遗留 物 ， 
将 在 竞赛 间歇 被 裁判 员 清 理 干 净 。 

机 器 人 在 试图 扑灭 火焰 前 ， 必 须 到 达 距 离 火 焰 30cm 以 内 。 在 距离 火焰 30cm 的 圆 上 有 
一 条 2. 5cm 宽 的 白 线 ， 机 器 人 在 扑灭 火焰 之 前 ， 必 须 有 一 部 分 在 圆圈 内 。 为 了 使 围绕 蜡烛 
的 圆圈 不 会 碰 到 代表 门 的 线 ， 蜡 烛 必 须 离 门 口 足够 远 。 螨 烛 将 随机 地 放 在 比赛 场地 的 任意 一 
个 房间 里 。 在 机 器 人 所 经 历 的 3 次 测试 中 ， 晴 烛 至 少 放 在 两 个 以 上 的 房间 里 测试 。 晴 烛 放 在 

间 房 子 的 任意 位 置 ， 但 不 能 放 在 走廊 上 。 机 器 人 的 前 端 在 进入 房间 碰 到 晴 烛 前 应 至 少 可 以 
移动 33cm。 两 款 灭 火 机 器 人 如 图 1-5 所 示 。 























图 1-5 灭火 机 器 人 


1.2.6 舞蹈 机 器 人 比赛 


舞蹈 机 器 人 比赛 是 一 项 观赏 性 很 强 的 比赛 。 机 器 人 舞蹈 既 具 有 极 强 的 观赏 性 和 趣味 性 ， 
更 是 一 个 系统 化 的 工程 设计 。 舞 蹈 机 器 人 涉及 了 机 电 一 体 化 技术 、 检 测 和 传 感 技术 、 精 密 加 
工 和 机 械 密封 技术 、 现 代 化 控制 技术 和 管理 技术 、 光 电感 应 技术 、 计 算 机 程序 控制 技术 等 多 
个 方面 ， 是 集成 了 多 学 科 前 沿 技术 的 运动 机 器 人 的 一 种 。 舞 蹈 机 器 人 比赛 需要 多 位 评委 为 机 
器 人 的 表现 打分 ， 是 一 项 融 技 术 与 艺术 于 一 体 的 比赛 。 在 地 界 重 大 的 RoboCup 比赛 中 ，Rob- 
oCup Junior 比赛 的 一 个 最 吸引 人 的 项 目 就 是 舞蹈 机 器 人 大 赛 。 男 外 ， 在 2001 年 由 日 本 发 起 
并 举办 的 “国际 机 老人 竞赛 节 (RoboFesta) ”中 ， 舞 蹈 机 器 人 比赛 也 由 最 初 的 表演 性 比赛 发 
展 到 现在 的 正式 比赛 项 目 。 两 个 比赛 的 基本 规则 类 同 ， 都 需要 考虑 机 器 人 的 技术 含量 和 艺术 
表现 力 两 个 方面 。 图 1-6 所 示 为 入 选美 国 科 技 杂 志 推 出 “机 器 人 明星 榜 ” 的 舞蹈 机 器 人 


“ En 
梦 露 ”。 


舞蹈 机 器 人 的 脸庞 脱胎 于 玛丽 莲 ， 梦 露 ， 长 长 的 裙 摆 藏 起 了 它 的 三 个 轮子 。 跳 舞 机 器 人 
高 1.6m， 能 像 人 一 样 跳 华 尔 兹 。 安 装 在 机 器 人 上 身 的 传 à 
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仅 会 跳舞 。 一 位 设计 者 说 :“ 机 器 人 可 以 通过 用 户 的 运动 ， 
预测 他 们 的 需求 ， 能 够 为 体弱多病 的 老人 或 残疾 人 提供 更 
到 位 的 服务 ， 这 些 人 只 要 发 出 口头 指令 便 可 以 。 


1.2.7 相 扑 机 器 人 比赛 


出 于 对 相 扑 运动 的 喜爱 ， 日 本 于 1990 年 3 月 举行 了 
第 一 届 相 扑 机 器 人 大 会 ， 大 会 举办 得 相当 成 功 ,同年 12 p 
月 又 举行 了 第 二 届 相 扑 机 器 人 大 会 。 自 次 年 起 ， 相 扑 机 器 ee Be E 
人 大 会 定 于 每 年 的 12 月 举行 。“ 相 扑 ” 是 一 个 体育 竞技 比 
赛 , 目标 是 通过 机 器 人 的 短 刃 接触 把 一 方 推出 界外 ， 是 
一 项 有 趣 而 激动 人 心 的 活动 ， 它 不 仅仅 是 一 个 展示 机 器 人 
技术 的 好 机 会 ， 更 能 体现 一 个 学 生 应 用 传 感 技术 对 信息 的 。 图 1.6 舞蹈 机 器 人 “ 梦 露 ” 
综合 处 理 能 力 和 创新 思维 。 

机 器 人 相 扑 比赛 的 规则 要 求 机 器 人 的 长 和 宽 不 得 超过 20cm ， 重 量 不 得 超过 3kg， 对 机 器 
人 的 身高 没有 要 求 ， 如 图 1.7 所 示 。 机 器 人 的 比赛 场地 是 高 Scm 、 直 径 为 154cm 的 圆 形 台 
面 。 台 面 上 敷 以 黑色 的 硬 质 橡胶 ， 硬 质 橡胶 的 边缘 处 涂 有 Scm 宽 的 白 线 。 这 种 以 黑白 两 色 
构成 边界 线 的 比赛 场地 便于 相 扑 机 器 人 利用 低 成 本 的 光电 传感器 进行 边界 识别 。 相 扑 机 器 人 
使 用 的 传感器 有 : 超声 波 传感器 、 触 觉 传感器 等 ， 成 本 也 都 不 高 。 正 是 由 于 费用 不 太 高 ， 所 
以 发 展 很 快 ， 到 1993 的 第 4 届 比 赛 ， 参 赛 机 器 人 已 超过 1000 台 。 由 于 竞技 过 程 是 双方 机 器 
人 “身体 ”的 直接 较量 ， 气 氛 紧 张 、 比 赛 激烈 。 





























图 1-7 相 扑 机 器 人 


相 扑 机 器 人 比赛 的 规则 比较 宽松 ， 给 参赛 者 留 有 较 大 的 发 挥 空间 。 比 如 ， 为 了 防止 被 对 
手 推 下 赛 台 ， 有 的 相 扑 机 器 人 采用 了 必要 时 可 将 自己 的 底部 吸附 在 比赛 场地 的 方法 ， 并 笔 这 


种 策略 多 次 赢得 了 胜利 。 
1.2.8 搏斗 机 器 人 


《机 器 人 大 擂台 》 是 由 英国 TNN 电视 台 发 起 并 组 织 的 世界 上 规模 最 大 的 科普 类 竞赛 方 
H, 1998 年 在 英国 电视 台 首 次 公演 。 截 至 2008 年 ， 它 的 搏斗 系列 已 经 覆盖 了 全 球 27 个 国 
家 ， 包 括 英国 、 美 国 、 珊 典 、 意 大 利 、 和 荷兰 等 。 其 中 的 很 多 国家 现在 也 发 展 了 自己 的 机 器 人 
大 战 系列 。 参 赛 的 机 器 人 选手 也 由 最 初 的 30 多 部 机 器 人 发 展 到 每 年 有 1700 多 部 机 器 人 参 
赛 ， 比 赛 的 科技 含量 和 激烈 程度 逐年 增加 ， 观 众 的 参与 兴趣 也 与 日 俱 增 。 同 时 ， 通 过 比赛 现 
场 的 讲解 ， 该 活动 也 丰富 了 世界 各 地 青少年 的 相关 科技 知识 ， 加 深 了 他 们 对 机 器 人 技术 的 兴 
趣 ， 极 大 地 增强 了 他 们 的 动手 能 

在 该 节目 中 ,参赛 选手 设计 并 制造 无 线 电 控制 的 格斗 机 器 人 以 角 斗 士 的 方式 进行 成 斗 ， 
欧 争 者 依赖 于 机 器 人 闪电 般 快速 的 反应 和 驱动 能 力 来 击败 对 手 。 这 些 精锐 的 机 器 人 不 仅 相 互 
之 间 战 斗 ， 并 且 要 与 主办 方 的 机 器 人 周旋 。 图 1-8 所 示 为 第 五 届 《 机 器 人 大 擂台 》 和 冠军 ， 也 
是 进入 格斗 机 器 人 名 人 答 的 “ 利 箭 ” 与 主办 方 设置 的 主场 机 器 人 “机 咒 骑 士 ” 。 主 场 机 器 人 
负责 在 场 上 巡逻 ， 摊 毁 并 分 解 进入 禁区 的 参赛 机 器 人 。 该 比赛 采取 类 似 足 球 联赛 的 形式 ， 组 
织 者 将 机 器 人 分 成 若干 小 组 ， 进 行 淘汰 赛 ， 直 至 决 出 一 个 总 冠军 。 在 淘汰 赛 中 机 器 人 在 障碍 
物 之 间 和 穿行 , 试图 击 倒 目标 。 挑战 越 大 ， 所 能 得 的 分 越 高 。 胜 者 直接 进入 半 决 赛 。 在 半 决 完 
中 ,机 器 人 在 格斗 场 上 相互 格斗 ， 直 到 其 中 一 个 机 器 人 被 击败 ， 如 果 出 现 平 局 ， 则 专家 委员 
会 将 根据 四 条 标准 〈 中 破坏 程度 ; Qt RU; OLE; 由 控制 ) ， 决 定 哪 个 机 器 人 取得 
胜利 。 后 来 又 经 过 改进 ， 障 碍 物 被 取消 ， 成 为 纯 机 器 人 格斗 比赛 ， 与 半 决 赛 规则 一 样 ， 彻 底 
摧毁 对 方 或 是 四 项 评分 较 高 的 机 器 人 将 获胜 。 














图 1-8 格斗 机 器 人 





1.3 ”国内 的 机 器 人 比赛 


机 器 人 竞赛 是 近年 来 国际 上 迅速 开展 起 来 的 一 种 高 科技 对 抗 活动 ， 它 涉及 人 工 智 能 、 自 
动 控 制 、 机 械 电 子 、 通 信 、 传 感 及 机 构 等 多 个 领域 的 前 沿 研究 和 技术 融合 。 它 集 高 科技 、 娱 
乐 和 比赛 于 一 体 。 同 时 机 品 人 技术 水 平 也 是 一 个 国家 科技 水 平 的 重要 标志 之 一 。 近 年 来 ， 在 
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我 国 大 学 ， 机 器 人 作为 机 械 电 子 学 、 计 算 机 技术 、 人 工 智能 等 的 典型 载体 被 广泛 地 用 来 作为 
工科 本 科 生 的 讲授 课程 之 一 ; 在 中 学 ， 模 型 机 器 人 则 逐渐 成 为 素质 教育 和 技能 实践 的 选 题 之 
一 ， 各 种 机 器 人 比赛 方兴未艾 。 

下 面 就 简要 介绍 一 下 国内 主要 的 机 器 人 竞赛 : 

1. 中 国 青 少年 电脑 机 器 人 比赛 

中 国 青 少年 电脑 机 器 人 比赛 是 由 中 国 科学 技术 协会 和 其 他 相关 部 门 共同 主办 ， 由 中 国 科 
学 技术 协会 青少年 部 和 省 、 自 治 区 、 直 辖 市 科学 技术 协会 ， 省 及 省 级 青少年 电脑 机 器 人 竞赛 
组 织 单位 等 共同 承办 。 大 赛 接 受 社 会 各 界 赞助 和 协办 。 

青少年 电脑 机 器 人 活动 ， 是 一 项 综合 多 种 学 科 知 识 和 技能 的 青少年 科技 活动 ， 护 子 们 通 
过 计算 机 编程 、 工 程 设 计 、 动 手 制 作 与 技术 构建 ， 结 合 孩 子 们 的 日 常 观察 、 积 累 ， 去 寻求 自 
己 最 完美 的 解决 方案 ， 发 展 自己 的 创造 力 。 中 国 青 少年 电脑 机 器 人 竞赛 是 以 弘扬 科学 技术 、 
突显 创造 与 创新 、 强 化 团队 贡献 、 培 养 科 学 素质 、 关 联 当 今世 界面 临 的 问题 与 机 遇 为 宗旨 。 
中 国 青少年 电脑 机 器 人 活动 将 现实 世界 的 事物 与 “动手 做 ”活动 相 结 合 ， 放 手 让 青少年 通 
过 活动 ， 去 发 现 解 决 问题 的 方法 ， 并 获得 那些 当今 科学 家 和 工程 师 : 
们 所 面 对 的 机 会 。 同 时 ， 它 也 是 中 国 科 学 技术 协会 在 21 世纪 青 少 
年 科技 创新 活动 中 着 力 创建 和 打造 的 一 个 胃 新 品牌 ， 是 青少年 科技 
竞赛 活动 探索 走向 社会 化 的 一 种 尝试 。 

赛事 包括 FLL (FIRST LEGO League 机 器 人 世锦 赛 ) 和 IROC 
(国际 机 器 人 奥林匹克 委员 会 ) 的 比赛 项 目 等 。 图 1-9 所 示 为 比赛 
中 的 一 款 机 器 人 。 

2. 亚太 大 学 生机 器 人 电视 大 赛 

作为 亚洲 广播 联盟 (ABU， 简 称 亚 广 联 ) 成 员 国 ， 中 央 电 视 
台 积 极 参与 亚 广 联 组 织 的 亚太 地 区 大 学 生机 器 人 电视 大 赛 ， 并 依据 
亚 广 联 当年 公布 的 比赛 主题 与 规则 ， 组 织 全 国 大 学 生机 器 人 电视 大 赛 ， 并 建立 了 专题 网 站 
一 一 全 国 大 学 生机 器 人 电视 大 赛 网 站 (http: 7/www. robocon. com. cn ) 。 全 国 大 学生 机 准 人 
电视 大 赛 由 中 央 电 视 台 主办 ， 教 育 部 、 科 技 部 、 中 国 科学 院 、 中 国 科学 技术 协会 共同 协办 。 
该 项 大 赛 的 目的 是 培养 和 开发 全 国 大 学 生 的 聪明 才智 与 创新 精神 ， 展 示 当 代 大 学 生机 器 人 制 
作 能 力 与 高 新 技术 应 用 水 平 。 比 赛 的 各 项 规程 由 中 央 电 视 台 本 着 “是 否 有 利于 学 生 的 科技 
创新 ， 是 否 有 利于 发 展 机 器 人 技术 ， 是 否 有 利于 比赛 的 精彩 性 与 可 观赏 性 ， 是 否 有 利于 机 器 
人 大 赛 的 健康 发 展 ”的 原则 ， 与 各 高 校 代 表 队 商议 制定 。 各 高 校 根 据 当 年 的 比赛 主题 ， 并 
结合 本 校 实际 情况 报名 参赛 ， 一 校 一 队 。 比 赛 设 冠军 1 名 、 亚 军 1 名 、 季 军 2 名 以 及 优胜 奖 
12 名 ， 其 中 冠 、 亚 、 季 和 盏 可 获得 由 组 委 会 颁发 的 奖金 ; 比赛 同时 还 设立 最 佳 创 意 、 最 佳 技 
术 、 最 佳 设计 、 最 佳 策略 和 最 佳 风格 等 奖项 ， 由 大 赛 评审 委员 会 根据 比赛 表现 评选 决定 。 

ABU Robocon (Asia Broadcast Unit Asia-Pacific Robot Contest， 亚 广 联 亚太 地 区 机 器 人 大 
赛 ) 是 由 亚 广 联 节 目 部 发 起 倡导 的 。 此 活动 的 前 身 是 日 本 广播 协会 的 机 器 人 比赛 ， 该 项 赛 
EM 1988 年 开始 ， 于 1989 年 成 为 日 本 广播 协会 (NHK) 每 年 的 赛事 ,命名 为 “全 日 本 机 
器 人 大 赛 ” 。1990 年 第 一 次 邀请 国外 代表 队 参 赛 ， 成 为 一 项 国际 性 比赛 ， 历 时 十 年 。 中 国清 
华 大 学 、 北 京 航 空 航天 大 学 和 上 海 交 通 大 学 都 曾 参 加 过 该 项 赛事 ， 其 中 清华 大 学 曾 于 1998 
年 获得 第 三 名 的 好 成 绩 。 














图 1-9 中 鸣 简 易 版 
积木 机 器 人 套件 
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2000 年 3 月 “ 亚 广 联 亚太 地 区 机 器 人 大 赛 ”第 一 次 筹备 会 议 在 日 本 举行 ， 成 立 了 “ 亚 
广 联 亚太 地 区 机 器 人 大 赛 ”筹备 委员 会 ， 并 选举 了 六 个 常任 理事 机 构 (中 国 CCTV、 日 本 
NHK 、 韩 国 KBS 、 新 加 坡 TCS、 泰 国 、 印 尼 ) ， 筹 备 委员 会 的 秘书 处 设 在 日 本 NHK 的 总 部 。 
2001 年 2 月 份 ， 在 马来西亚 召开 了 第 一 届 “ 亚 广 联 亚太 地 区 机 器 人 大 赛 ”的 预备 会 议 。 

2002 年 8 月 31 日 ， 由 亚 广 联 主办 、 日 本 NHK 承办 的 第 一 届 亚 太 地 区 机 器 人 大 赛 的 总 
决赛 在 日 本 东京 成 功 落下 了 帷幕 。 参 加 此 次 比赛 的 有 来 自 包括 中 国 科技 大 学 和 澳门 大 学 在 内 
的 19 个 国家 和 地 区 的 20 支 代 表 队 ， 竞 相 参与 题 为 “攀登 富士 山顶 ”的 角逐 。 中 国 科技 大 
学 在 比赛 中 一 路 过 关 斩 将 ， 在 决赛 中 由 于 场地 太 滑 ， 机 器 人 无 法 接近 得 分 最 多 的 “富士 山 
頂 " ， 以 两 分 之 差 惜败 给 越南 胡志明 市 科技 大 学 队 ， 获 得 亚军 。 图 1-10 所 示 为 中 国 队 与 越南 
队 的 比赛 。 








图 1-10 ”中国 队 与 越南 队 比 赛 


每 届 大 赛 的 主题 由 承办 国 提 出 。 第 一 届 大 赛 由 日 本 提出 “ 侈 登 语 士 山 ” ， 第 二 届 大 赛 由 
泰国 提出 “ 腾 球 太空 占领 者 ”， 第 三 届 大 赛 由 韩国 提出 “级 桥 相 会 "”， 都 力图 跟 自己 的 民族 
文化 联系 起 来 。 第 四 届 大 赛 由 中 国 主办 ， 提 出 的 主题 是 : “ 登 长 城 点 圣火 ”， 这 也 跟 我 国 的 
历史 文化 和 举办 奥运 密切 相关 。 机 器 人 大 赛 和 足球 比赛 不 一 样 ， 在 足球 比赛 中 ， 观 众 的 喝彩 
能 够 增强 运动 员 的 斗志 ,鼓舞 士气 。 但 在 机 器 人 大 赛 中 ,机 絮 人 听 到 喝彩 、 助 威 不 会 激动 ， 
反而 有 可 能 影响 操作 机 器 的 人 正常 发 挥 。 有 时 决赛 上 场 时 机 絮 人 发 生 故 障 ， 到 最 后 一 刻 被 淘 
汰 ， 非 常 可 惜 。 机 絮 人 大 赛 的 主要 看 点 : 一 是 机 器 人 高 智能 的 表演 ， 二 是 选手 高 超 的 战术 ， 
三 是 双方 高 水 平 的 “ 智 斗 ” 。 实 际 上 ， 机 咒 人 比赛 ， 最 好 看 、 最 精彩 、 最 激烈 的 往往 就 在 关 
键 的 三 分 钟 里 。 因 此 ， 可 以 说 是 “精彩 三 分 钟 ， 感 动 三 分 钟 。 

除了 每 年 的 承办 国之 外 ， 其 他 国家 或 地 区 每 年 只 能 有 一 只 参赛 队 代 表 国家 出 征 ABU - 
Robocon。 我 国 中 央 电 视 台 为 了 选拔 能 够 代表 中 国 参 赛 的 代表 队 ， 自 2002 年 开始 举办 中 央 电 
视 台 机 器 人 电视 大 赛 (简称 CCTV-Robocon) ， 以 选拔 队伍 参加 亚 广 联 亚太 地 区 大 学 生机 器 人 
K, 
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目前 ， 全 国 大 学 生机 器 人 电视 大 赛 已 经 成 功 举 办 了 14 届 ， 北 京 科技 大 学 代表 队 表 现 优 
异 ， 共 获得 2 次 冠军 , 4 次 亚军 ，3 次 季军 。 在 第 四 届 全 国 大 学 生机 器 人 此 赛 中 ,北京 科技 
大 学 获得 国内 选拔 赛 的 冠军 ， 并 与 亚军 哈尔滨 工程 大 学 一 起 代表 中 国 队 ， 参 加 在 北京 举办 的 
主题 为 “ 登 长 城 点 圣火 ”的 亚太 地 区 大 学 生机 品 人 大 赛 。 在 小 组 赛 的 第 一 轮 北京 科技 大 学 
代表 队 就 与 卫 网 冠军 越南 队 相 遇 ， 经 过 激烈 的 争夺 ， 北 京 科技 大 学 代表 队 以 13: 9 击败 对 手 ， 
使 后 者 未 能 进入 下 一 轮 比赛 。 之 后 又 一 路 疤 关 ， 在 决赛 中 与 日 本 的 东京 大 学 代表 队 相遇 ， 经 
过 激烈 的 对 抗 ， 最 终 以 37:42 的 比分 惜败 于 对 手 ， 取 得 了 我 国 参加 同类 比赛 的 最 好 成 绩 。 取 
得 ABU 总 决赛 亚军 的 北京 科技 大 学 代表 队 如 图 1-11 所 示 。 








图 1-11 2005 年 ABU 总 决赛 亚军 一 一 北京 科技 大 学 代表 队 





3. 中 国 机 器 人 大 赛 

中 国 机 器 人 大 赛 是 由 中 国 自 动 化 学 会 机 器 人 竞赛 工作 委员 会 和 科技 部 高 新 技术 研究 发 展 
中 心 主办 的 一 次 全 国 性 竞赛 活动 ， 大 赛 每 年 举行 一 次 ， 截 止 到 2005 年 底 已 举办 了 五 届 比 赛 。 
大 赛 是 国际 Robo Cup, FIRA 等 组 织 在 中 国 惟一 的 授权 组 织 和 联系 通道 ， 由 一 批 全 国 重 点 大 
学 专家 、 教 授 担任 评委 ， 戴 汝 为 、 化 稚 捍 等 10 多 位 院士 、20 多 位 “863” 机 器 人 专家 担任 
顾问 。 

全 国 机 器 人 大 赛 展示 了 我 国 在 研究 智能 机 器 人 上 所 做 的 不 懈 努 力 和 突出 成 就 ， 展 现 了 中 
国 高 校 大 学 生 的 创新 意识 和 能 力 。 机 器 人 大 赛 以 科技 含量 高 、 学 科 跨 度 宽 、 参 与 面 广 和 展示 
性 强 等 特点 在 国际 上 有 着 很 强 的 影响 力 。 它 涉及 人 工 智 能 、 图 像 处 理 、 通 信 传 感 、 精 密 机 构 
和 自动 控制 等 多 领域 的 前 沿 研 究 和 技术 集成 。 专 家 预测 ， 机 器 人 产业 在 21 世纪 将 成 为 和 汽 
车 、 计 算 机 并 驾 齐 驱 的 主干 产业 。 从 庞大 的 工业 机 器 人 到 微观 的 纳米 机 器 人 ， 从 尖端 的 仿 人 
机 器 人 到 孩子 们 喜爱 的 机 器 人 宠物 ， 机 器 人 正 日 益 走 近 我 们 的 生活 ， 成 为 人 类 最 亲密 的 伙 
伴 。 目 前 已 经 形成 了 一 个 国际 联盟 的 人 工 智能 和 机 器 人 项 目 开发 目标 ， 被 世界 各 国 科 研 机 构 
和 众多 高 等 院 校 所 重视 。 国 内 的 教育 和 科研 机 构 也 日 益 关 注 机 器 人 事业 的 发 展 ， 清 华 大 学 、 
中 国 科技 大 学 等 著名 高 校 基本 形成 了 完整 的 课程 体系 ， 对 推动 高 校 的 科技 创新 和 产 学 研一 体 
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化 产生 了 积极 作用 ， 也 为 提高 我 国 在 机 器 人 领域 的 国际 地 位 做 出 了 积极 贡献 。 








机 器 人 大 赛 以 足球 机 器 人 (Robo- 器 m I | 
Cup 和 FIRA) 为 主要 项 目 。 在 足球 机 F mo Oey | a 
闫 人 系统 开发 过 程 中 ， 不 仅 要 遇 到 机 尖 E a 
人 学 、 机 电 一 体 化 、 通 信 与 计算 机 技术 Bg A Xen 
等 ， 而 且 涉及 图 像 处 理 、 传 感 器 数据 融 : ae TA 
合 、 决 策 与 对 策 、 模 糊 神 经 网 络 、 人 工 
生命 与 智能 控制 等 学 科 的 内 容 。 此 外 ， 蝇 
还 有 机 器 人 灭火 、 机 器 人 舞蹈 、 机 器 人 
走 迷 宫 、 机 器 人 越野 、 机 器 人 创意 等 ， 
其 中 RoboCup 比赛 以 其 独特 的 魅力 ， 
已 成 为 各 类 国际 机 器 人 竞赛 中 最 具 水 平 

影响 力 的 赛事 之 一 。Robocup 中 型 组 
比赛 如 图 1-12 所 示 。 图 1-12 Robocup 中 型 组 比赛 

4. 中 国 青 少年 机 器 人 比赛 

中 国 青少年 机 器 人 竞赛 活动 ， 是 20 世纪 末 由 中 国 科 学 技术 协会 青少年 工作 部 积极 创意 
并 组 织 开展 的 一 项 青少年 科技 活动 ， 是 中 国 科学 技术 协会 在 21 世纪 青少年 科技 创新 活动 中 
着 力 创建 和 打造 的 一 个 记 新 品牌 。 随 着 电子 、 信 息 技 术 的 应 用 与 迅速 普及 ， 青 少年 电脑 机 器 
人 活动 如 雨后春笋 ， 在 我 国 已 有 30 LAA, AAK, HETEN. WA, OUS, HF 
制作 机 器 人 活动 已 成 为 新 世纪 中 小 学 校 青 少年 科技 创新 活动 的 新 亮点 和 新 领域 。 中 国 青少年 
机 器 人 竞赛 以 丰富 多 彩 、 形 式 多样 的 机 器 人 探究 项 目 ， 激 发 广大 青少年 的 创新 思维 和 实践 能 
力 。 这 项 活动 最 具 创 新 精神 、 创 新 意识 与 创新 能 力 的 培养 ， 孩 子 们 通过 电脑 机 器 人 活动 可 以 
进行 计算 机 编程 、 工 程 设计 、 动 手 制作 与 技术 构建 ， 同 时 也 可 以 结合 他 们 的 日 常 观 察 、 积 
累 ， 去 寻求 自己 最 完美 的 解决 问题 的 方案 ， 发 展 自己 的 创造 力 。 

自 2001 年 起 ， 这 项 活动 已 成 为 我 国 青少年 每 年 一 度 的 重大 科技 赛事 。 目 前 ， 全 国 百 余 
万 青少年 电脑 机 器 人 爱好 者 通过 各 种 形式 投身 于 电脑 机 器 人 的 高 科技 竞技 与 机 器 人 科学 研究 
和 工程 研究 活动 中 。 

中 国 科学 技术 协会 已 相继 在 广东 、 河 南 、 广 西 等 地 成 功 举办 了 16 届 中 国 青 少年 机 器 人 
竞赛 。 第 16 届 中 国 青少年 机 器 人 竞赛 由 中 国 科 学 技术 协会 、 中 国 科学 院 主办 ， 中 国 科 协 青 
少年 科技 中 心 与 国防 科技 大 学 承办 ， 北 京 青少年 科技 中 心 和 怀柔 区 人 民政 府 协办 。 共 有 来 自 
全国 30 个 省 市 区 、 新 疆 生 产 建设 兵团 、 和 香港、 澳门 及 中 国 儿童 中 心 选派 的 497 支 参赛 队 的 
1412 名 中 小 学 生 报名 参加 机 器 人 综合 技能 比赛 、FLL 机 器 人 工程 挑战 赛 、VEX 机 器 人 工程 
挑战 赛 及 机 器 人 足球 比赛 四 个 类 别 。 第 16 届 青 少年 机 器 人 竞赛 是 中 国 科 协 首次 与 中 国 科学 
院 联合 主办 。 国 科大 作为 承办 高 校 ， 把 丰富 的 科研 教育 资源 融入 到 竞赛 活动 中 。 赛 会 期 间 ， 
四 场 一 线 科 学 家 的 科普 报告 和 “两 弹 一 星 ” 纪 念 馆 等 特色 参观 活动 ， 让 参赛 学 生 和 辅导 教 
练 了 解 到 不 同 科 研 领域 的 研究 历程 和 前 沿 方向 ， 带 给 学 生 和 教练 们 很 多 人 生 和 治学 的 启迪 。 
竞赛 中 涌现 了 很 多 创意 独特 的 机 器 人 作品 和 多 样 化 的 解决 方案 。 这 也 说 明 越 来 越 多 的 学 校 、 
家 庭 和 校外 教育 机 构 对 科学 和 工程 技术 教育 越 来 越 重视 ， 促 进 了 学 生机 器 人 科技 活动 水 平 的 
提高 ， 极 大 地 丰富 了 青少年 的 课外 活动 ， 让 学 生 的 学 习 变 成 了 充满 碰撞 、 游 戏 、 尝 试 和 反思 
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的 过 程 。 

机 器 人 技术 综合 了 多 学 科 的 发 展 成 果 ， 代 表 了 高 新 技术 的 发 展 前 沿 及 其 在 人 类 生活 应 用 
领域 的 不 断 扩大 。 通 过 组 织 丰 富 多 彩 的 青少年 机 右 人 竞赛 ， 必 将 促进 我 国 机 器 人 科技 术 平 的 
提高 与 活动 的 普及 ， 激 发 广大 青少年 对 科技 的 兴趣 ， 提 高 青少年 的 科学 素质 ， 为 我 国 机 器 人 
研究 和 开发 储蓄 后 备 人 才 。 

5 “ 飞 思 卡尔 ” 杯 全 国 大 学 生 智能 车 竞赛 

作为 全 球 最 大 的 汽车 电子 半导体 供应 商 ， 飞 思 卡 尔 半 导体 公司 一 直 致 力 于 为 汽车 电子 系 
统 提 供 全 范围 应 用 的 单片机 、 模 拟 器 件 和 传感器 等 器 件 产 品 和 解决 方案 。 汽 车 电子 应 用 已 涵 
盖 了 从 汽车 电子 控制 装置 到 车 载 汽 车 电子 装置 的 几乎 所 有 系统 。 电 子 控制 即 通过 电子 装置 控 
制 汽车 发 动机 、 底 盘 、 和 车身、 制 动 防 抱 死 及 动力 转向 系统 等 ， 而 车 载 汽 车 电子 装置 包括 汽车 
言 息 娱 乐 系统 、 导 航 系统 、 汽 车 音响 及 车 载 通信 系统 等 。 

在 这 样 的 行业 背景 下 ， 教 育 部 为 了 加 强大 学 生 实践 、 创 新 能 力 和 团队 精神 ， 培 养 面 向 未 
来 的 科技 尖端 人 才 ， 在 已 举办 的 全 国 数学 建 模 、 电 子 设 计 、 机 械 设计 、 结 构 设 计 等 四 大 专业 
竞赛 的 基础 上 ， 设 立 了 第 五 项 大 学 生 设 计 竞 赛 一 一 全 国 大 学 生 智 能 汽车 竞赛 。 

“ 飞 思 卡尔 ” 杯 全 国 大 学 生 智能 汽车 竞赛 由 高 等 学 校 自 动 化 专业 教学 指导 分 委员 会 主 
办 ， 尺 思 卡 尔 半 导体 公司 协办 ， 采 用 邀请 赛 方式 。 比 赛 以 迅猛 发 展 的 汽车 电子 为 背景 ， 涵 盖 
了 控制 、 模 式 识 别 、 传 感 技 术 、 电 子 、 电 气 、 计 算 机 、 机 械 等 方面 的 技术 ， 是 多 个 学 科 交 义 
的 科技 创意 性 比赛 ， 智 能 车 集 所 有 机 器 人 技术 为 一 身 是 一 项 重要 的 机 器 人 赛事 。 旨 在 培养 大 
学 生 对 知识 的 把 握 和 创新 能 力 ， 以 及 从 事 科 学 研究 的 能 

比赛 以 飞 思 卡尔 汽车 用 MC9S12DG128 16 位 微 控 制 器 作为 智能 模型 车 的 主 控 忌 片 。 组 委 
会 提供 统一 智能 车 竞赛 车 模 、 飞 思 卡 尔 的 HCS12 单片机 开发 板 、CodeWarrior 开发 软件 和 在 
线 调试 工具 等 。 要 求 参赛 队伍 在 车 模 平 台 基础 上 ， 自 主 构思 控制 方案 及 系统 设计 ， 包 括 传 感 
器 信号 采集 处 理 、 控 制 算 法 及 执行 、 动 力 电动 机 驱动 、 转 向 舵 机 控制 等 ， 完 成 智能 车 工程 制 
作 及 调试 。 制 作出 一 个 能 够 自主 识别 路 线 的 智能 车 ， 在 专门 设计 的 跑道 上 自动 识别 道路 行 
驶 。 比 赛 名 次 将 主要 取决 于 赛车 单 圈 最 短 时 间 。 

第 一 届 (2006 年 ) : 承办 : 清华 大 学 

特等 奖 : 清华 大 学 

第 二 届 (2007 年 ) : 承办 : 上 海 交通 大 学 

特等 奖 : 上 海 交通 大 学 

第 三 届 (2008 Æ): 承办 : 东北 大 学 

摄像 头 组 ” 冠 、 亚 、 季 军 : 东北 大 学 、 北 京 科技 大 学 、 上 海 交 通 大 学 

光电 组 W E, FE: 武汉 科技 大 学 、 北 京 科技 大 学 、 东 北大 学 

第 四 届 (2009 年 ): 承办 : 北京 科技 大 学 

RRRA W, E, FE: 北京 科技 大 学 、 上 海 交通 大 学 、 上 海 大 学 

光电 组 W, E, FRE: 北京 科技 大 学 、 清 年 大 学 、 杭州 申 子 科技 大 学 

第 五 届 (2010 Æ): 承办 : 杭州 电子 科技 大 学 

BARRA W, E, FE: 北京 科技 大 学 、 杭 州 电子 科技 大 学 信息 工程 学 院 、 南 京师 范 
























































光电 组 W W, FE: 杭州 电子 科技 大 学 、 杭 州 电子 科技 大 学 信息 工程 学 院 、 乐 山 师 
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范 学 院 
电磁 组 冠 、 亚 、 季 军 : 广东 技术 师范 学 院 、 清 华 大 学 、 杭 州 电 子 科 技 大 学 
第 六 届 (2011 年 ) : 承办 : 西北 工业 大 学 
RERA W. W FRE: 湖南 大 学 、 北 京 科技 大 学 、 山 东 大 学 
光电 组 W, E, FE: 西北 工业 大 学 、 电 子 科技 大 学 、 乐 山 师范 学 院 
电磁 组 冠 、 亚 、 季 和 军 : 杭州 电子 科技 大 学 、 北 京 科 技 大 学 、 西 北 工业 大 学 
第 七 届 (2012 年 ) : 承办 : 南京 师范 大 学 
REKA W. W FRE: 北京 科技 大 学 、 常 熟 理 工学 院 、 电 子 科技 大 学 
光电 组 W E, FE: 北京 科技 大 学 、 山 东 大 学 、 乐 山 师范 学 院 
电磁 组 冠 、 亚 、 季 军 : 中 南 民 族 大 学 、 浙 江 大 学 、 华 中 科技 大 学 
第 八 届 (2013 年 ) : 承办 : 哈尔滨 工业 大 学 
REKA W. W FRE: 北京 科技 大 学 、 武 汉 科技 大 学 、 西 安 交 通 大 学 
光电 组 W WE, FE: 北京 科技 大 学 、 厦 门 大 学 、 厦 门 大 学 嘉 庚 学 院 
电磁 组 冠 、 亚 、 季 军 : 电子 科技 大 学 、 北 京 科技 大 学 、 东 北大 学 秦皇岛 分 校 
第 九 届 (2014 年 ) : 承办 : 电子 科技 大 学 
REKA W. E FRE: 南京 师范 大 学 、 北 京 科技 大 学 、 电 子 科技 大 学 
光电 组 W, E, FE: 北京 科技 大学 、 中 南 民族 大 学 、 华 中 科技 大 学 
电磁 组 冠 、 亚 、 季 军 : 北京 科技 大 学 、 浙 江 大 学 、 电 子 科技 大 学 
第 十 届 (2015 年 ) : 承办 : 山东 大 学 
摄像 头 组 ” 冠 、 亚 、 季 军 : 厦门 大 学 、 北 京 科技 大 学 、 山 东 大 学 
光电 组 W WE, FE: 重庆 大 学 、 中 南大 学 、 北 京 科 技 大 学 
电磁 组 冠 、 亚 、 季 军 : 北京 科技 大 学 、 天 津 大 学 、 中 南 民族 大 学 


1.4 ”竞赛 机 器 人 平台 的 主要 功能 


竞赛 机 器 人 是 人 工 智能 技术 、 人 工 心理 、 机 器 人 学 、 机 电 一体 化 技术 、 通 信和 与 计算 机 技 
术 、 视 觉 与 传 感 顺 技术 、 智 能 控制 与 决策 、 多 智能 体系 统 实 时 模式 识别 与 行为 系统 、 智 能 体 
结构 设计 、 实 时 规划 和 推理 、 基 于 网 络 的 三 维 图 形 交 互 、 多 智能 体 技 术 〈Multi-Agent) 、 图 
像 识别 技术 的 综合 应 用 ; 在 现实 中 ， 竞赛 机 器 人 的 组 织 者 始终 奉行 研究 与 教育 相 结 合 的 根本 
宗旨 。 比 赛 与 学 术 研 究 的 巧妙 结合 更 激发 了 青年 学 生 的 强烈 兴趣 ,通过 比赛 培养 了 青年 学 生 
严 并 的 科学 研究 态度 和 良好 的 技能 ， 为 普及 科技 、 提 高 学 生 兴趣 、 加 强 我 国 科 技 实力 做 出 了 
一 定 贡献 。 

通过 对 竞赛 机 器 人 平台 技术 进行 细致 研究 ， 制 作 了 一 个 竞赛 机 咒 人 试验 平台 ， 重 点 是 设 
计 了 平台 的 共 轴 两 轮 独立 驱动 的 合理 化 结构 ,合理 布 置 了 红外 发 射 接收 传 感 咯 、 色 差 传 感 
器 ， 大 大 增强 了 试验 平台 的 功能 ， 提 高 了 传感器 的 抗 干扰 能 力 ， 提 高 了 传 感 需 检测 距离 的 精 
度 ， 降 低 了 机 器 人 的 功 耗 。 基 于 这 个 竞赛 机 器 人 平台 ， 可 以 很 容易 地 组 装 起 迷宫 机 器 人 、 灭 
火 机 器 人 、 寻 线 机 需 人 、 滑 雪 机 器 人 、 足 球 机 器 人 等 ， 可 以 快速 组 队 参 加 比赛 ， 同 时 减少 了 
试验 时 间 ， 减 少 了 寻找 合适 的 配件 的 时 间 ， 把 重点 放 在 解决 特定 任务 的 算法 上 ， 大 大 地 提高 
了 工作 效率 。 
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同时 基于 这 个 平台 ， 可 以 很 容易 地 开展 人 工 智 能 各 种 算法 的 试验 、 单 片 机 试验 、 电 动机 
驱动 试验 、 传 感 絮 的 试验 、C 语言 编程 的 试验 等 ， 可 以 说 也 是 一 个 很 好 的 综合 试验 平台 ， 适 
合 于 大 学 自动 化 专业 、 计 算 机 专业 、 电 子 信息 等 专业 的 各 类 试验 。 该 机 器 人 平台 也 是 一 款 适 
合 于 中 小 学 开展 科普 活动 的 有 效 教具 ， 通 过 竞赛 机 器 人 平台 可 以 完成 许多 有 创意 的 功能 及 比 
赛 ， 如 会 走 S 形 的 迷宫 机 器 人 、 妃 人 机 器 人 、 追 光 机 器 人 、 滑 雪 机 妖 人 、 救 援 机 器 人 等 。 

竞赛 机 器 人 平台 技术 主要 涉及 了 人 工 智能 、 自 动 控制 、 机 械 电 子 、 通 信 、 传 感 及 机 构 等 
多 个 领域 的 前 治 研 究 和 技术 融合 。 这 里 以 不 同 的 竞赛 机 器 人 为 例 ， 分 别 来 介绍 其 中 涉及 的 文 
撑 技 术 ， 见 表 1-1。 

















表 1-1 各 种 竞赛 机 器 人 的 主要 支撑 技术 
类 型 主要 支撑 技术 








分 布 式 人 工 智 能 技术 、 智 能 机 器 人 技术 、 机 器 人 学 、 机 电 一 体 化 技术 

通信 与 计算 机 技术 、 视 觉 与 传感器 技术 、 智 能 控制 与 决策 、 多 智能 体系 统 、 实 时 模 
式 识别 与 行为 系统 、 智 能 体 结构 设计 、 实 时 规划 和 推理 、 基 于 网 络 的 三 维 图形 交 互 、 
多 智能 体 技 术 、 图 像 识别 技术 


























1 RoboCup 竞赛 























机 器 人 足球 竞赛 的 理论 研究 、 机 器 人 足球 相关 的 视觉 系统 、 运 动 规划 、 动 作 设计 、 

策略 选择 
视频 采集 /处 理 、 电 子 和 计算 机 技术 、 检 测 及 传感器 技术 、 多 智能 体 技术 、 单 片 机 
技术 、 人 工 智 能 技术 、 神 经 网 络 技术 





2 FIRA 竞赛 





















































多 电动 机 控制 技术 、 人 体 运动 学 、 伺 服 电 动机 控制 技术 、 机 电 一 体 化 技术 
检测 及 传感器 技术 、 单 片 机 技术 、 人 工 智 能 技术 、 电 子 和 计算 机 技术 

































































伺服 电机 控制 技术 、 机 电 一 体 化 技术 、 检 测 及 传感器 技术 、 单 片 机 技术 、 人 工 智 能 
技术 、 神 经 网 络 技术 、 电 子 和 计算 机 技术 






































司 服 电动 机 控制 技术 、 机 电 
5 寻 线 机 器 人 竞赛 IS 机 








体 化 技术 、 检 测 及 传感器 技术 、 单 片 机 技术 、 人 工 智 






































伺服 电动 机 控制 技术 、 机 电 一 体 化 技术 、 检 测 及 传感器 技术 、 单 片 机 技术 、 人 工 智 









































_ 多 电动 机 控制 技术 、 人 体 运动 学 、 伺 服 电动 机 控制 技术 、 机 电 
7 rf: 距 L = に 
BA 检测 及 传感器 技术 、 人 工 智能 技术 








体 化 技术 


















































司 服 电动 机 控制 技术 、 机 电 T. REM 感 es 8, AT 
$ 相 扑 机 器 人 竞赛 伺服 电动 机 控制 技术 、 机 电 一 体 化 技术 、 检 测 及 传感器 技术 、 单 片 机 技术 、 人 工 箱 


能 技术 、 电 子 和 计算 机 技术 
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从 地 界 上 第 一 台 遥 控 机 械 手 的 诞生 至 今 已 有 50 年 了 ,在 这 短 短 的 几 年 里 ， 伴 随 着 计算 
机 、 自 动 控制 理论 的 发 展 和 工业 生产 的 需要 及 相关 技术 的 进步 ， 机 器 人 的 发 展 已 经 历 了 三 
代 : 

1) FY a AE HY AN BE AY Lai A ; 

2) 基于 传感器 控制 具有 一 定 自主 能 力 的 机 器 人 ; 

3) 智能 机 器 人 。 

简单 地 说 ， 所 谓 机 器 人 的 控制 器 就 是 机 器 人 的 大 脑 ， 就 像 人 的 大 脑 文 配 人 的 四 肢 来 完成 
动作 一 样 ， 机 器 人 的 控制 器 控制 机 器 人 的 各 个 部 分 来 实现 机 器 人 的 功能 。 作 为 机 器 人 的 核心 
部 分 ， 机 器 人 控制 器 是 影响 机 器 人 性 能 的 关键 部 分 之 一 。 它 从 一 定 程度 上 影响 着 机 器 人 的 发 
展 。 目 前 ， 由 于 人 工 智 能 、 计 算 机 科学 、 传 感 器 技术 及 其 他 相关 学 科 的 长 足 进 步 ， 使 得 机 顺 
人 的 研究 在 高 水 平 上 进行 ， 同 时 也 对 机 器 人 控制 器 的 性 能 提出 更 高 的 要 求 。 

对 于 不 同类 型 的 机 器 人 ， 如 竞赛 机 器 人 与 工业 机 器 人 ， 控 制 系统 的 综合 方法 就 有 较 大 差 
别 ， 控 制 铝 的 设计 方案 也 不 一 样 。 这 里 仅 讨论 竞赛 机 器 人 控制 需 问 题 。 


2.2 机 器 人 控制 器 类 型 























机 器 人 控制 器 是 根据 指令 以 及 传 感 信息 控制 机 器 人 完成 一 定 的 动作 或 作业 任务 的 装置 ， 
它 是 机 器 人 的 心脏 ,决定 了 机 器 人 性 能 的 优 劣 。 
从 机 器 人 控制 算法 的 处 理 方式 来 看 ， 控 制 铝 可 分 为 串 行 、 并 行 两 种 结构 类 型 。 


2.2.1 串 行 处 理 结构 


所 谓 的 串 行 处 理 结构 是 指 机 器 人 的 控制 算法 是 由 串 行 机 来 处 理 。 对 于 这 种 类 型 的 控制 
器 ， 从 计算 机 结构 、 控 制 方式 来 划分 ， 又 可 分 为 以 下 几 种 : 

1. 单 CPU 结构 、 集 中 控制 方式 

用 一 台 功 能 较 强 的 计算 机 实现 全 部 控制 功能 。 在 早期 的 机 器 人 中 ， 如 Hero-I, Robot-I 
等 ， 就 采用 这 种 结构 ， 但 控制 过 程 中 需要 许多 计算 (如 坐标 变换 ) ， 因 此 这 种 控制 结构 速度 
较 慢 ， 实 时 性 差 、 难 以 扩展 ， 其 构成 框图 如 图 2-1 所 示 。 

2. 两 级 CPU 结构 、 主 从 式 控 制 方式 

一 级 CPU 为 主机 ， 担 当 系 统管 理 、 机 器 人 语言 编译 和 人 机 接口 功能 ， 同 时 也 利用 它 的 
运算 能 力 完成 坐标 变换 、 轨 迹 插 补 ， 并 定时 地 把 运算 结果 作为 关节 运动 的 增 量 送 到 公用 内 
存 ， 供 二 级 CPU 读 取 ; 二 级 CPU 完成 全 部 关节 位 置 数字 控 制 。 这 类 系统 的 两 个 CPU 总 线 之 
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同 基 本 没有 険 系 , 付 通 辻 公 用 内 存 交換 数 据 , EPR IRR HOR ADE 2% HY CPU 进 
一 步 分 散 功能 是 很 困难 的 。 日 本 于 20 世纪 70 年 代 生 产 的 Motoman 机 器 人 (5 关节 ， 直 流 电 
动机 驱动 ) 的 计算 机 系统 就 属于 这 种 主 从 式 控 制 方式 ， 其 构成 框图 如 图 2-2 所 示 。 主 从 控制 
方式 系统 实时 性 比较 好 ， 适 用 于 高 精度 、 高 速度 控制 ,但 其 系统 扩展 性 较 差 ， 维 修 困难 。 
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图 22 主 从 控制 方式 结构 框图 


3. 多 CPU 结构 、 分 布 式 控制 方式 

目前 ， 普 遍 采 用 这 种 上 、 下 位 机 两 级 分 布 式 结构 ， 上 位 机 负责 整个 系统 管理 及 运动 学 计 
算 、 轨 迹 规划 等 。 下 位 机 由 多 CPU 组 成 ， 每 个 CPU 控制 一 个 关节 运动 ， 这 些 CPU 和 上 位 机 
联系 是 通过 总 线形 式 的 紧 耦 合 。 这 种 结构 的 控制 器 工作 速度 和 控制 性 能 明显 提高 。 但 这 些 多 
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CPU 系统 共有 的 特征 都 是 针对 具体 问题 而 采用 的 功能 分 布 式 结构 ， 即 每 个 处 理 需 承担 固定 
任务 。 各 模式 之 间 可 以 是 主 从 关系 ， 也 可 以 是 平等 关系 。 这 种 方式 实时 性 好 ， 易 于 实现 高 
速 、 高 精度 ， 易 于 扩展 ， 可 实现 智能 控制 ， 其 结构 如 图 2-3 所 示 。 目 前 世界 上 大 多数 商品 化 
机 絮 人 控制 器 都 是 这 种 结构 。 

以 上 几 种 类 型 的 控制 需 都 是 采用 趾 行 机 来 计算 机 器 人 控制 算法 。 它 们 存在 一 个 共同 的 弱 
点 : 计算 负担 重 、 实 时 性 差 。 所 以 大 多 采用 离线 规划 和 前 馈 补 偿 解 耦 等 方法 来 减轻 实时 控制 
中 的 计算 负担 。 当 机 器 人 在 运行 中 受到 干扰 时 ， 其 性 能 将 受到 影响 ， 更 难以 保证 高 速 运动 中 
所 要 求 的 精度 指标 。 

由 于 机 器 人 控制 算法 的 复杂 性 以 及 机 器 人 控制 性 能 的 或 竺 提高， 许多 学 者 从 建 模 、 算 法 
等 多 方面 进行 了 减少 计算 量 的 努力 ， 但 仍 难以 在 串 行 结构 控制 器 上 满足 实时 计算 的 要 求 。 因 
此 ， 必 须 从 控制 器 本 身 寻 求解 决 办 法 。 方 法 之 一 是 选用 高 档次 微机 或 小 型 机 ; 另 一 种 方法 就 
是 采用 多 处 理 需 作 并 行 计 算 ， 提 高 控制 器 的 计算 能 
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图 2-3 ”分 布 式 控制 方式 结构 框图 





2.2.2 并 行 处 理 结构 


并 行 处 理 技术 是 提高 计算 速度 的 一 个 重要 而 有 效 的 手段 ， 能 满足 机 器 人 控制 的 实时 性 要 
求 。 关 于 机 器 人 控制 器 并 行 处 理 技 术 ， 人 们 研究 较 多 的 是 机 器 人 运动 学 和 动力 学 的 并 行 算法 
及 其 实现 。1982 年 , J. Y.S. Luh 首次 提出 机 器 人 动力 学 并 行 处 理 问题 ， 这 是 因为 关节 型 机 
咒 人 的 动力 学 方程 是 一 组 非 线性 强 耦 合 的 二 阶 微分 方程 ， 计 算 十 分 复杂 。 提 高 机 器 人 动力 学 
算法 计算 速度 也 为 实现 复杂 的 控制 算法 (如 计算 力矩 法 、 非 线性 前 馈 法 、 自 适应 控制 法 等 ) 
打下 基础 。 开 发 并 行 算 法 的 途径 之 一 就 是 改造 串 行 算法 ,使 之 并 行 化 ， 然 后 将 算法 映射 到 并 
行 结构 。 一 般 有 两 种 方式 : 一 是 考虑 给 定 的 并 行 处 理 絮 结构 ， 根 据 处 理 右 结构 所 支持 的 计算 
模型 ， 开 发 算法 的 并 行 性 ; 二 是 首先 开发 算法 的 并 行 性 ， 然 后 设计 支持 该 算法 的 并 行 处 理 需 
结构 ， 以 达到 最 佳 并 行 效率 。 

构造 并 行 处 理 结构 的 机 器 人 控制 器 的 计算 机 系统 一 般 采用 以 下 方式 : 

1. 开发 机 器 人 控制 专用 超大 规模 集成 电路 (VLSI) 

设计 专用 超大 规模 集成 电路 (VLSI) 能 充 分 利用 机 准 人 控 制 算法 的 井 行 性 , 依 華 芯 片 
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PY ASIF AT AS RAT Sy FAR DL A 8 tll BIS PTE, BAK Geena oe. oA 
方程 的 计算 速度 。 但 由 于 忌 片 是 根据 具体 的 算法 来 设计 的 ， 当 算法 改变 时 ， 忌 片 则 不 能 使 
用 ， 因 此 采用 这 种 方式 构造 的 控制 器 不 能 通用 ， 更 不 利于 系统 的 维护 与 开发 。 

2. 利用 有 并 行 处 理 能 力 的 芯片 式 计算 机 (如 Transputer, DSP 等 ) 构成 并 行 处 理 网 络 

Transputer 是 英国 Inmos 公司 研制 并 生产 的 一 种 并 行 处 理 用 的 芯片 式 计算 机 。 利 用 
Transputer 芯片 的 4 对 位 串通 信 的 链接 对 ， 易 于 构造 不 同 的 拓扑 结构 ， 且 Transputer 具有 极 强 
的 计算 能 力 。 利 用 Transputer 并 行 处 理 器 ， 人 们 构造 了 各 种 机 器 人 并 行 处 理 器 ， 如 流水 线 
型 、 树 型 等 。 

随 着 数字 信和 号 处 理 忆 片 速度 的 不 断 提 高 ， 高 速 数字 信号 处 理 器 (DSP) 在 信息 处 理 的 各 
个 方面 得 到 广泛 应 用 。DSP 以 极 快 的 数字 运算 速度 见长 ， 并 易于 构成 并 行 处 理 网 络 。 

3. 利用 通用 的 微 处 理 器 

利用 通用 微 处 理 需 构成 并 行 处 理 结构 ， 支 持 计 算 ， 实 现 复 杂 控 制 策略 在 线 实时 计算 。 

从 前 面 的 介绍 可 以 知道 ， 串 行 处 理 结构 的 优点 是 硬件 结构 比较 简单 ， 处 理 方便 ， 但 对 于 
计算 量 比较 大 的 系统 来 说 负担 较 重 、 实 时 性 差 ， 并 行 处 理 结构 相对 来 说 结构 较为 复杂 ， 因 具 
有 数据 的 并 行 处 理 能 力 ， 实 时 性 较 好 。 竞 赛 机 右 人 平台 的 功能 相对 较为 简单 ， 要 求 的 运算 量 
也 不 大 ， 串 行 处 理 结构 足 可 以 满足 要 求 。 


2.3 三 种 机 器 人 控制 器 的 比较 


单片机 亦 称 单 片 微型 电脑 或 单 片 微型 计算 机 ， 国 际 上 统称 为 微 控 制 器 ， 就 是 将 中 央 处 理 
AJG (CPU), EFT iir (ROM ) 、 数 据 存储 絮 (RAM) 以 及 输入 输出 (WO0) 端口 等 部 
件 集 成 在 一 片 大 规模 或 超大 规模 集成 电路 上 的 超 微 型 计算 机 。 现 代 社 会 中 ,单片机 有 着 极为 
广泛 的 应 用 领域 ， 如 自动 控制 、 智 能 仪表 、 数 据 采 集 系 统 、 外 部 设备 控制 系统 、 家 用 电器 
等 。 在 竞赛 机 器 人 的 控制 系统 中 ， 就 是 以 单片机 为 核心 的 。 

8 位 单片机 由 于 内 部 构造 简单 、 体 积 小 、 成 本 低廉 ， 在 一 些 较 简单 的 控制 絮 中 应 用 很 
广 。 由 于 8 位 单片机 种 类 繁多 ， 这 里 仅 将 常用 的 几 种 单片机 在 性 能 上 作 一 个 简单 的 比较 。 


2.3.1 51 系列 单片机 


应 用 最 广泛 的 8 位 单片机 首 推 tel 的 51 系列 ， 由 于 产品 硬件 结构 合理 ， 指 令 系统 规 
范 ， 加 之 生产 历史 “和 悠久 "” ， 有 先 人 为 主 的 优势 。 世 界 有 许多 著名 的 芯片 公司 都 购买 了 51 
芯片 的 核心 专利 技术 ， 并 在 其 基础 上 进行 性 能 上 的 扩充 ， 使 得 芯片 得 到 进一步 的 完善 ， 形 成 
了 一 个 庞大 的 体系 ， 直 到 现在 仍 在 不 断 翻 新 ， 把 单片机 世界 炒 得 沸沸扬扬 。 有 人 推测 ，51 
芯片 可 能 最 终 形成 事实 上 的 标准 微 控制 器 (MCU) 芯片 。 

51 系列 优点 之 一 是 它 从 内 部 的 硬件 到 软件 有 一 套 完整 的 按 位 操作 系统 ， 称 作 位 处 理 器 
或 布尔 处 理 屁 。 它 的 处 理 对 象 不 是 字 或 字 节 而 是 位 。 它 不 光 能 对 片 内 某 些 特殊 功能 寄存 絮 的 
某 位 进行 处 理 ， 如 传送 、 置 位 、 清 零 、 测 试 等 ， 还 能 进行 位 的 逻辑 运算 ， 其 功能 十 分 完备 ， 
使 用 起 来 得 心 应 手 。 虽 然 其 他 种 类 的 单片机 也 具有 位 处 理 功能 ， 但 能 进行 位 逻辑 运算 的 实 属 
少见 。51 系列 单片机 在 片 内 RAM 区 间 还 特别 开辟 了 一 个 双重 功能 的 地 址 区 间 ， 有 16 FW, 
单元 地 址 为 20H ~2FH， 它 既 可 作 字 节 处 理 ， 也 可 作 位 处 理 ( 作 位 处 理 时 , 合 128 位 ， 相 应 
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位 地 址 为 00H ~7FH) ， 使 用 极为 灵活 。 这 一 功能 无 疑 给 使 用 者 提供 了 极 大 的 方便 ， 因 为 一 
个 较 复 杂 的 程序 在 运行 过 程 中 会 遇 到 很 多 分 支 ， 因 而 需 建 立 很 多 标志 位 ， 在 运行 过 程 中 ， 需 
要 对 有 关 的 标志 位 进行 置 位 、 清 零 或 检测 ， 以 确定 程序 的 运行 方向 。 而 实施 这 一 处 理 ( 包 
括 前 面 所 有 的 位 功能 ) ， 只 需 用 一 条 位 操作 指令 即 可 。 

【 例 2-1】 如 对 21H 的 第 0 位 (相应 位 地 址 为 08H) 置 位 ， 只 需 用 一 条 位 指令 
SETB08H， 对 周围 的 其 他 位 不 会 产生 影响 。 

有 的 单片机 并 不 能 直接 对 RAM 中 的 位 进行 操作 ， 如 AVR 系 列 単 片 机 中 , 若 想 対 RAM 
中 的 某 位 置 位 时 ， 必 须 通过 状态 寄存 器 SREG 的 T 位 进行 中 转 。 

【 例 22】 如 对 RAM 中 的 RO 寄存 器 的 第 4 位 置 位 ， 则 : 

BSET6; 状态 寄存 器 了 置 位 

BLD RO, 4; 将 T 位 复制 到 RO 的 第 4 位 

显然 ，AVR 系列 单片机 比 51 系列 单片机 要 复杂 。 

51 系列 单片机 的 男 一 个 优点 是 乘法 和 除法 指令 ， 这 给 编程 也 带 来 了 便利 。8 位 除 以 8 位 
的 除法 指令 ， 商 为 8 位 ， 精 度 嫌 不 够 ， 用 得 不 多 。 而 8 位 乗 8 位 的 乘法 指令 ， 其 乘积 为 16 
位 ， 精 度 还 是 能 满足 要 求 的 ， 用 得 较 多 。 作 乘法 时 ， 只 需 一 条 指令 就 行 了 ， 即 MPLAB (两 
个 乘 数 分 别 在 累加 器 A 和 寄存 器 B 中 。 积 的 低位 字 节 在 累加 器 A 中 ， 高 位 字 节 在 寄存 器 B 
中 ) 。 很 多 8 位 单片机 都 不 具备 乘法 功能 ， 作 乘法 时 还 得 编 一 段子 程序 调用 ， 十 分 不 便 。 

在 51 系列 单片机 中 ， 还 有 一 条 二 进 制 转换 成 十 进 制 调整 指令 DA ， 能 将 二 进 制 变 为 BCD 
码 ， 这 对 于 十 进 制 的 计量 十 分 方便 。 而 在 其 他 的 单片机 中 ， 则 也 需 调 用 专用 的 子 程序 才 行 。 

Intel 公司 51 系列 单片机 的 典型 产品 是 8051， 片 内 有 4KB 的 一 次 性 可 编程 (OTP) 存储 
fro Atmel 公司 就 将 其 改 为 电 可 改写 的 闪 速 (Flash) 存储 器 ， 人 允许 改写 1000 次 以 上 ， 这 给 
编程 和 调试 带 来 极 大 的 便利 ， 其 AT89C51 、AT89CS2 等 产品 成 为 了 当今 最 流行 的 8 位 单 片 
机 。 

51 系列 单片机 的 VO 引 脚 的 设置 和 使 用 非常 简单 ， 当 该 引 脚 作 为 输入 引 脚 使 用 时 ， 只 
需 将 该 引 脚 设置 为 高 电 平 (复位 时 ， 各 IO 引 脚 均 置 高 电 平 ) 。 当 该 引 脚 作为 输出 引 脚 使 用 
时 ， 则 为 高 电 平 或 低 电 平均 可 。 低 电 平时 ， 吸 入 电流 可 达 20mA， 具 有 一 定 的 驱动 能 力 ; 而 
高 电 平时 ， 输 出 电流 仅 数 十 微 安 甚 至 更 小 〈 电 流 实际 上 是 由 引 脚 的 上 拉 电 流 形成 的 ) ， 基 本 
上 没有 驱动 能 力 。 其 原因 是 高 电 平时 ， 该 引 脚 也 同时 作为 输入 引 脚 使 用 ， 而 输入 引 脚 必须 具 
有 高 的 输入 阻抗 ， 因 而 上 拉 的 电流 必须 很 小 才 行 。 作 为 输出 引 脚 使 用 ， 欲 进行 高 电 平 驱 动 
时 ， 得 利用 外 电路 来 实现 (E24), O0 引 脚 不通 , 申 流 
经 R 驱动 发 光 二 极 管 (LED) 发 光 ; REF, 10 引 脚 导 
通 ， 电 流 由 该 引 脚 和 地，LED 熄灭 (LO 引 脚 导 通 时 对 地 的 
电压 降 小 于 1V，LED 的 阔 值 为 15~1.8V)。 

51 系列 单片机 1/0 引 脚 使 用 简单 ， 但 高 电 平 时 无 输出 
能力 , FARIA ME, ALAA APL (如 PIC 系列 、 
AVR 系列 等 ) 对 IO sig EGS Fee, HN Tr Tal A FE aE 
以 确定 输入 或 输出 ， 但 使 用 也 变 得 复杂 。 

一 些 简 装 的 51 系列 单片机 产品 也 相应 出 现 ， 如 Atmel 
公司 的 AT89C1051 、AT89C2051 、AT89C4051 等 〈 闪 速 存储 图 24 VO 脚 的 高 电 平 输 出 电路 
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器 分 别 为 1KB、2KB、4KB 等 ， 但 不 能 外 接 数据 存储 器 ) ， 指 令 系 统 与 AT89C51 完全 兼 容 , 
但 引 脚 均 为 20 个 ， 不 光 体 积 小 ， 而 且 价格 低廉 ， 这 使 得 其 他 的 公司 竞相 仿造 。 

A, 原 51 系列 单片机 也 有 许多 值得 改进 之 处 ， 例 如 运行 速度 过 慢 等 。 当 品 体 振荡 频 
率 为 12MHz 时 ， 机 器 周期 达 1us， 显 然 适 应 不 了 现代 高 速 运行 的 需要 。 华 邦 (Winbond) 公 
司 生产 的 单片机 产品 型 号 有 W77 系列 和 W78 系列 。W78 系列 与 AT89C 系 列 完全 兼 容 。W77 
系列 为 增强 型 ， 对 原 有 的 8051 的 时 序 作 了 改进 ， 每 个 机 需 周 期 从 12 个 时 钟 周期 改 为 4 个 时 
钟 周期 ， 使 速度 提高 了 三 倍 ， 同 时 ， 品 体 振荡 频率 最 高 可 达 4OMH 2, W77 系列 还 增加 了 看 
门 狗 (Watchdog) 定时 器 、 两 组 通用 异步 收发 需 (UART) 、 两 组 数据 指针 (DPTR ) 、 在 线 
系统 可 编程 (ISP) 等 多 种 功能 。 

特别 是 两 组 数据 指针 ， 能 给 编程 带 来 很 大 的 便利 。 在 51 系列 单片机 中 ， 数 据 指针 
(DPTR) 是 片 内 与 片 外 的 数据 存储 器 打交道 的 主要 途径 〈 由 片 外 数据 存储 器 读 和 人 片 内 累加 
a A 或 由 片 内 累加 器 A 写 入 片 外 数据 存储 器 ) ， 也 是 程序 存储 器 与 累加 器 A 之 间 的 数据 传送 
的 必由之路 。 由 于 频繁 的 交换 数据 ， 特 别 是 数据 块 的 搬运 和 比较 ， 数 据 指针 非常 吃紧 ， 它 需 
要 不 断 地 实施 现场 保护 与 还 原 ， 不 光 编 程 变 得 复杂 ， 而 且 运 行 速度 也 减 慢 。 而 当 采 用 两 组 数 
据 指针 时 ， 可 以 各 负 其 责 ， 互 不 相 扰 ， 轻 松 地 完成 上 述 过 程 。 两 组 数据 指针 的 选取 取决 于 特 
丈 功能 寄存 器 AUXR1 的 第 DO 位 DPS, = DPS 为 0 时 ， 选 中 数据 指针 DPTRO (复位 时 DPS 
也 为 0); DPS 为 1 时， 选中 数据 指针 DPTR1。DPS 位 不 能 位 寻 址 ， 故 不 能 进行 布尔 操作 ， 
但 由 于 AUXRI 的 D1 位 被 强制 为 逻辑 “0”， 不 可 能 发 生 由 DO 位 向 D1 位 的 进位 ， 因 而 可 以 
通过 对 AUXR1 进行 增 1 来 使 DO 位 由 0 变 为 1 或 由 1 变 为 0， 从 而 达到 两 组 数据 指针 的 快速 
切换 的 目的 。 

ISP 功能 能 实现 在 系统 可 编程 ， 可 以 省 去 通用 的 编程 器 ， 单 片 机 在 用 户 板 上 即 可 下 载 和 
烧 录 用 户 程序 ， 而 无 需 将 单片机 从 生产 好 的 产品 上 取 下 。 未 定型 的 程序 还 可 以 边 生产 边 完 
善 ， 加 快 了 产品 的 开发 速度 ， 减 少 了 新 产品 因 软件 缺陷 带 来 的 风险 。 由 于 可 以 将 程序 下 载 并 
观看 运行 结果 ， 故 也 可 以 不 用 仿真 器 。 

单片机 的 提速 运行 、 两 组 DPTR 及 ISP 功能 并 非 是 W77 系列 所 特有 的 ， 一 些 新 型 的 51 
系列 产品 大 都 有 该 功能 ， 如 Philips 公司 的 51LPC 系列 、AT89 系列 中 的 某 些 型 号 、STC89C 
系列 等 。 有 的 单片机 还 附 有 A/D 转换 、D/A 转换 、 片 内 数据 存储 器 (EEPROM), PWM f 
出 、 PC 总 线 、 上 电 复 位 检测 、 欠 电压 复位 检测 等 ， 这 些 新 系列 的 单片机 ， 它 们 都 兼容 8051 
的 指令 系统 。 增 强 功能 的 实现 ， 大 都 是 由 片 内 新 增 的 特殊 功能 寄存 需 来 进行 设置 ， 这 些 寄 存 
顺和 被 安排 在 片 内 特殊 功能 寄存 器 区 间 (80 ~ FFH) 的 预 留 地 址 上 。 

比较 有 代表 性 的 产品 还 有 STC89C51RC 、C8051F331/330 等 。 可 以 这 么 说 ， 新 的 51 系列 
单片机 产品 几乎 可 以 涵盖 所 有 新 的 功能 。 由 于 新 型 号 的 芯片 种 类 太 多 ， 此 处 不 可 能 一 一 列 
举 ， 读 者 可 根据 使 用 的 需求 查阅 相关 的 资料 。 


2.3.2 PIC 系列 单片机 


PIC 系列 单片机 是 美国 微 芯 公司 (Microship) 的 产品 ， 是 当前 市 场 份额 增长 最 快 的 单 片 
机 之 一 。CPU 采用 精简 指令 集 计算 机 (RISC) 结构 ， 分 别 有 33、35、58 条 指令 〈 视 单片机 
的 级 别 而 定 ) 。 而 51 系列 单片机 有 111 RES, AVR 单片机 有 118 条 指令 ， 都 比 PIC 系列 单 
片 机 复杂 。 采 用 哈佛 (Harvard) 双 总 线 结构 ， 运 行 速度 快 (指令 周期 约 为 160 ~ 200ns ) , 
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它 能 使 程序 存储 器 的 访问 和 数据 存储 器 的 访问 并 行 处 理 ， 这 种 指令 流水 线 结构 ， 在 一 个 周期 
内 完成 两 部 分 工作 : 一 是 执行 指令 ; 二 是 从 程序 存储 器 取出 下 一 条 指令 ， 这 样 总 的 看 来 每 条 
指令 只 需 一 个 周期 (个 别 除 外 )， 这 也 是 高 效率 运行 的 原因 之 一 。 此 外 ， 它 还 具有 低 工作 电 
压 、 低 功 耗 、 驱 动能 力 强 等 特点 。PIC 系列 单片机 共 分 三 个 级 别 : 基本 级 、 中 级 、 高 级 。 其 
中 ， 又 以 中 级 的 PIC16F873 (A), PIC16F877 (A) 用 得 最 多 ， 本 书 以 这 两 种 单片机 为 例 进 
行 说 明 。 这 两 种 芯片 除了 引出 脚 不 同 外 (PIC16F873 (A) 为 28 脚 的 塑料 双 列 直 插 式 封装 
(PDIP) 或 小 外 廊 集 成 电路 (SOIC) 封装 ; PIC16F877 (A) 为 40 脚 的 PDIP Bk 44 脚 的 塑料 
有 引线 片 式 载体 (PLCC) 封装 、 方 形 扁平 封装 (QFP) ) ， 其 他 的 差别 并 不 很 大 。 

PIC 系列 单片机 的 1/0 端口 是 双向 的 ， 其 输出 为 CMOS 互补 推 挽 输 出 电路 。LO 引 脚 增 
加 了 用 于 设置 输入 或 输出 状态 的 方向 寄存 器 (TRISn， 其 中 对 应 各 端口 ， 如 A、B、C、D、 
E 等 ) ， 从 而 解决 了 51 系列 0 引 脚 为 高 电 平时 同 为 输入 和 输出 的 状态 。 当 置 位 1 时 ， 为 输 
和 人 状态 ， 且 不 管 该 引 脚 呈 高 电 平 或 低 电 平 ， 对 外 均 呈 高 阻 状态 ; 置 位 0 时 ， 为 输出 状态 ， 不 
管 该 引 脚 为 何 种 电 平 ， 均 呈 低 阻 状态 ， 有 相当 的 驱动 能 力 ， 低 电 平 吸入 电流 达 25mA， 高 电 
平 输出 电流 可 达 20mA。 相 对 于 51 系列 单片机 而 言 ， 这 是 一 个 很 大 的 优点 ， 它 可 以 直接 驱动 
数码 管 显示 ， 并 且 外 电路 比较 简单 。 它 的 AZD 为 10 位 ， 能 满足 精度 要 求 。 具 有 在 线 调试 及 
编程 (ISP) 功能 。 

该 系列 单片机 的 特殊 功能 寄存 器 (SFR) 并 不 像 51 系列 单片机 那样 都 集中 在 一 个 固定 
的 地 址 区 间 内 (80 ~ FFH) ， 而 是 分 散在 4 个 地 址 区 间 内 ， 即 存储 体 0 (Bank0: 00 ~7FH) 、 
存储 体 1 (Bankl : 80 ~FFH) 、 存 储 体 2 (Bank2 : 100 ~17FH) 、 存 储 体 3 (Bank3 : 180 ~ 
1FFH ) 。 只 有 5 个 专用 寄存 器 PCL、STATUS、FSR、PCLATH 、 INTCON 在 4 个 存储 体内 同时 
出 现 。 在 编程 过 程 中 ， 少 不 了 要 与 专用 寄存 器 打交道 ， 得 反复 地 选择 对 应 的 存储 体 ， 也 即 对 
状态 寄存 器 STATUS 的 第 6 位 (RPL) 和 第 5 位 (RPO) 置 位 或 清 零 。 这 多 少 给 编程 带 来 了 
一 些 麻烦 。 对 于 上 述 的 单片机 ， 它 的 位 指令 操作 通常 限制 在 存储 体 0 区 间 (00 ~7FH) 。 

数据 的 传送 和 逻辑 运算 基本 上 都 得 通过 工作 寄存 器 双 (相当 于 51 系列 单片机 的 累加 器 
A) 来 进行 ， 而 51 系列 单片机 还 可 以 通过 寄存 器 相互 之 间 直 接 传送 (如 : MOV 30H, 20H; 
将 寄存 器 20H 的 内 容 直 接 传 送 至 寄存 器 30H 中 ) ， 因 而 PIC 单片机 的 瓶颈 现象 比 51 系列 单 
片 机 还 要 严重 ， 这 在 编程 中 很 有 感受 。 


2.3.3 AVR 系列 单片机 


AVR 系列 单片机 是 Atmel 公司 推出 的 较为 新 颖 的 单片机 ， 其 显著 的 特点 为 高 性 能 、 高 速 
度 、 低 功 耗 。 它 取消 机 器 周期 ， 以 时 钟 周 期 为 指令 周期 ， 实 行 流水 作业 。AVR 系列 单片机 
首 令 以 字 为 单位 ， 且 大 部 分 指令 都 为 单 周期 指令 。 而 单 周 期 指令 既 可 执行 本 指令 功能 ， 同 时 
完成 下 一 条 指令 的 读 取 。 通 常 时 钟 频率 用 4 ~8MHz， 故 最 短 指令 执行 时 间 为 250 ~ 125ns。 
该 系列 的 型 号 较 多 , 但 可 用 下 面 三 种 为 代表 : AT90S2313 (faj A), AT90S8515 
AT90S8535 ( 帯 A-D 转换 ) 。 

通用 寄存 器 一 共有 32 不 (RO~R31), 前 16 个 寄存 器 (RO ~ R1S ) 都 不 能 直接 与 立即 
数 打交道 ， 因 而 通用 性 有 所 下 降 。 而 在 51 系列 单片机 中 ， 它 所 有 的 通用 寄存 器 〈 地 址 为 00 
~7FH) 均 可 以 直接 与 立即 数 打 交道 ， 显然 要 优 于 前 者 。 

AVR 系列 单片机 没有 类 似 累 加 器 A 的 结构 ， 它 主要 是 通过 R16 ~ R31 寄存 絮 来 实现 A 
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的 功能 。 在 AVR 系列 单片机 中 ， 没 有 像 51 系列 单片机 那样 的 数据 指针 (DPTR)， 而 是 由 X 
(由 R26、R27 组 成 )、Y (由 R28 R29 组 成 )、Z (H R30 、R31 组 成 ) 三 个 16 位 寄存 器 来 
完成 数据 指针 的 功能 (相当 于 有 三 组 DPTR) ， 而 且 还 能 作 后 增 量 或 先 减 量 等 的 运行 。 

在 51 系列 单片机 中 ， 所 有 的 逻辑 运算 都 必须 在 A 中 进行 ; 而 AVR 系列 单片机 中 却 可 以 
在 任 两 个 寄存 右 之 间 进 行 ， 省 去 了 在 A 中 的 来 回 折腾 ， 这 些 都 比 51 系列 单片机 强 。 

AVR 系列 单片机 的 专用 寄存 器 集中 在 00 ~3F 地 址 区 间 ， 无 须 像 PIC 系列 单片机 那样 先 
进行 选 存储 体 的 过 程 ， 使 用 起 来 比 PIC 系列 单片机 方便 。AVR 系列 单片机 的 片 内 RAM 的 地 
址 区 间 为 0060 ~00DF (AT90S2313 ) 和 0060 ~025F (AT90S8515、AT90S8535)， 它 们 占用 
的 是 数据 空间 的 地 址 ， 这 些 片 内 RAM 仅仅 是 用 来 存储 数据 的 ， 通 常 不 具备 通用 寄存 器 的 功 
能 。 当 程序 复杂 时 ， 通 用 寄存 器 RO ~ R31 就 显得 不 够 用 ; 而 51 系列 单片机 的 通用 寄存 髓 多 
达 128 个 (为 AVR 系列 单片机 的 4 倍 ) ， 编 程 时 就 不 会 有 这 种 感觉 。 

AVR 系列 单片机 的 VO 引 脚 类 似 PIC 系列 单片机 ， 它 也 有 用 来 控制 输入 或 输出 的 方向 
寄存 器 ， 在 输出 状态 下 ， 高 电 平 输出 的 电流 在 10mA 左右 ， 低 电 平 吸 入 电流 为 20mA。 虽 不 
如 PIC 系列 单片机 ， 但 比 51 系列 单片机 强 。 

以 上 的 三 种 AVR 系列 单片机 型 号 其 引 肢 与 对 应 的 51 系列 单片机 兼容 ， 如 AT90S2313 与 
51 系列 的 AT89C2051 的 引 脚 兼容 (PDIP-20 脚 ) , AT90S8515 AT9OS8535 与 51 系列 的 
AT89C51 兼容 (PDIP40 脚 ) 等 。 

通过 对 几 种 单片机 性 能 的 比较 ， 并 且 考 虑 到 PIC 系列 芯片 的 稳定 性 能 和 抗 干扰 能 力 较 
强 ， 最 终 选 用 了 Microchip ( 微 芯 ) 公司 生产 的 PIC16F877 (A) 芯片 作为 本 竞赛 机 器 人 平台 
的 控制 系统 ， 下 面具 体 介 绍 一 下 该 芯片 。 



































2.4 PIC16F877 (A) PIC 系列 单片机 


Microchip 公司 推出 的 PIC 8 位 单片机 系列 是 业内 率先 采用 精简 指令 集 计算 机 (Reduced 
Instruction Set Computer, RISC) 结构 的 高 性 能 价格 比 的 能 入 式 控制 器 (Embedded Comput- 
er) 。 其 高 速度 、 低 工作 电压 、 低 功 耗 、 较 大 的 输入 输出 直接 驱动 能 力 、 一 次 性 可 编程 
(One Time Program，OTP)、 低 价位 、 小 体积 等 ， 都 体现 了 微 控制 器 工业 发 展 的 新 趋势 。 


2.4.1 PIC 系列 单片机 性 能 特点 


1. 哈佛 (Harvard) 双 总 线 结构 

这 样 的 存储 结构 是 基于 哈佛 双 总 线 概念 ， 数 据 和 指令 传输 总 线 完 全 分 开 ， 以 避免 典型 的 
普通 复杂 指令 集 计算 机 (CISC) 设计 中 经 党 出现 的 瓶颈 问题 。 传 统 的 汉 “' AR SE 
算 机 是 在 同一 个 存储 空间 取 指 令 和 数据 ( 即 普 林 斯 顿 结构 )， 两 者 不 能 同时 进行 ， 故 限制 了 
工作 带宽 。 而 在 哈佛 结构 的 计算 机 中 ， 指 令 和 数据 空间 是 完全 分 开 的 ， 一 个 用 于 指令 ， 男 一 
个 用 于 数据 。 由 于 可 以 对 程序 和 数据 同时 进行 访问 ， 所 以 提高 了 数据 吞吐 率 。 正 因为 在 PIC 
系列 单片机 中 采用 了 哈佛 双 总 线 结构 ， 所 以 与 常见 的 微 控 制 器 不 同 的 一 点 是 : 程序 和 数据 总 
线 可 以 采用 不 同 的 宽度 ， 数 据 总 线 都 是 8 位 的 ， 但 低档 、 中 档 和 高 档 系 列 的 指令 总 线 位 数 分 
别 为 12、14 和 16 位 。 图 2-5 所 示 是 两 种 不 同 结构 的 计算 机 示意 图 。 
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数据 和 冯 , 诺 伊 曼 结构 
CPU 程序 存储 器 ( 普林斯顿 结构 ) 





sias Ko) œu Ko 程序 存储 器 哈佛 结构 


图 2-5 计算 机 的 两 种 不 同 结构 示意 图 


2. 指令 单字 节 化 

因为 数据 总 线 和 指令 总 线 是 分 离 的 ， 并 且 采 用 了 不 同 的 宽度 ， 所 以 程序 存储 器 (ROM) 
和 数据 存储 器 (RAM) 的 寻 址 空间 ( 即 地 址 编码 空间 ) 是 相互 独立 的 ， 而 且 两 种 存储 器 宽 
度 也 不 同 。 这 样 设计 ， 不 仅 可 以 确保 数据 的 安全 性 ， 还 能 提高 运行 速度 和 实现 全 部 指令 的 单 
FTE. 

3. 类 RISC (RISC-like) 结构 

这 为 8 位 单片机 市 场 设 立 了 一 种 事实 上 的 新 的 性 能 标准 。 为 了 达到 独一无二 的 高 速 性 
能 ，PIC 单片机 采用 了 小 型 机 设计 结构 。 

先进 的 类 RISC 结构 体现 在 每 一 条 高 效率 和 功能 强大 的 指令 上 。 三 个 系列 微 控制 器 的 指 
令 都 是 单字 的 宽 字 位 指令 : 低档、 中 档 和 高 档 系列 的 指令 位 数 分 别 为 12、14 和 16 位 ， 且 分 
别 呈 有 33、35 和 38 条 指令 ， 它 们 向 上 兼容 。 其 指令 系统 除了 程序 分 文 指令 是 单字 双 周 期 指 
令 外 ， 其 他 指令 都 是 单字 单 指令 周期 。 在 这 些 指令 中 ， 没 有 功能 交叉 的 指令 ， 使 得 所 有 的 指 
令 具 有 简洁 性 。 单 字 宽 指令 提供 了 软件 编码 的 效率 ， 减 少 了 所 需要 的 程序 存储 单元 ， 使 系统 
具有 最 高 处 理 效率 和 突出 性 能 。 另 外 ， 由 于 所 用 指令 数 较 少 和 较 简 洁 ， 编 程 任务 和 调试 任务 
相对 就 比较 容易 ， 而 且 学 习 和 实现 都 非常 快 。 在 相同 情况 下 ，PIC 单片机 所 需要 的 编码 比 一 
般 微 处 理 器 要 少 一 半 ， 其 指令 的 高 效率 又 可 以 使 得 开发 时 间 节 约 30% 。 

4. 寻 址 方式 简单 

PIC 系列 单片机 只 有 4 种 寻 址 方式 〈 即 寄存 器 间接 寻 址 、 立 即 数 寻 址 、 直 接 寻 址 和 位 寻 
址 ) 容易 掌握 。 

5. 代码 压缩 率 高 

1KB 的 存储 空间 ， 对 于 像 51 系列 这 样 的 单片机 ， 大 约 只 能 存放 600 条 指令 ， 而 对 于 
PIC 系列 单片机 ， 则 能 够 存放 的 指令 条 数 多 达 1024 条 。 

6. 运行 速度 高 









































由 于 采用 了 哈佛 总 线 结构 ， 以 及 指令 的 读 取 和 执行 采用 了 流水 作业 方式 ， 使 得 运行 速度 
大 大 提高 。 
7. DWAR 


PIC 系列 单片机 的 功率 消耗 极 低 ， 其 中 有 些 型 号 ， 在 4MHz 时 钟 下 工作 时 耗 电 不 超过 
2mA ， 在 睡眠 模式 下 耗 电 可 以 达到 1pA 以 下 。 

8. 驱动 能 力 强 

VO 端口 驱动 负载 的 能 力 较 强 ， 每 个 1/0 引 脚 吸入 和 输出 电流 的 最 大 值 可 以 分 别 达到 
25mA 和 20mA， 能 够 直接 驱动 发 光 二 极 管 (LED) 、 光 耦合 器 或 者 微型 继电器 。 
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9. PC 和 SPI 串 行 总 线 端口 

用 这 两 种 串 行 总 线 技术 可 以 实现 芯片 间 同步 串 行 数据 传输 。 

10. 寻 址 空间 设计 简洁 

PIC 系列 单片机 的 程序 、 堆 栈 、 数 据 三 者 各 自 采 用 互相 独立 的 寻 址 〈 或 抵制 编码 ) ， 而 
且 前 两 者 的 地 址 安排 不 需要 用 户 操心 。 

11. 保密 性 好 

PIC 以 保密 熔 丝 来 保护 代码 ， 用 户 在 烧 入 代码 后 熔断 熔 丝 ， 别 人 再 也 无 法 读 出 ， 除 非 恢 
FAL. HAT, PIC 采用 燃 丝 深 埋 工艺 ， 恢 复 熔 丝 的 可 能 性 极 小 。 

12. 外 界 电 路 简洁 

该 系列 单片机 内 集成 上 电 复位 电路 ，LO 端口 上 拉 电 路 ， 看 门 狗 定 时 器 等 电路 ， 符 合 真 
正 意义 上 的 “ 纯 单 片 ” 应 用 。 


2.4.2 PIC16F87X 单片机 的 结构 与 性 能 特点 
本 竞赛 机 器 人 平台 具体 选用 的 单片机 型 号 为 PIC16F877， 芯 片 的 外 形 如 图 2-6 所 示 。 
Wr rm le A. YN t ny 
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图 2-6 PIC16F877 芯 片 的 外形 


PIC16FS77 引 脚 排列 如 图 2-7 所 示 。 








MCLR/Vpp 1 RB7 
RAO/ANO 2 RB6 
RA1/AN1 3 RBS 

RA2/AN2/VREF 4 RB4 
RA3/AN3/VREF 5 RB3 
RA4/TOCK1 6 RB2 
RAS/AN4/SS 7 RB1 
RE0/RD/ANS 8 a RBO/INT 
RB1/ WR / AN6 9 i VYDD 
RE2/CS/AN7 S Vss 
VDD Q RD7/PSP7 
Vss E RD6/PSP6 
OSC1/CLKIN RD5/PSP5 
OSC2/CLKOUT RD4/PSP4 
RC0/T10S0/T1CK1 RC7/RX/DT 
RC1/T1OS1/CCP2 RC6/TX/CK 
RC2 /CCP1 RC5/SDO 
RC3/SCK/SCL RC4/SDI/SDA 

RDO/PSPO RD3/PSP3 

RD1/PSP1 RD2/PSP2 


2-7 PIC16F877 单片机 的 引 脚 排列 


PICLOF87X 系列 单片机 内 部 机 构 如 图 2-8 所 示 。 
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数据 地 址 
14 位 32 个 SFR 





指令 地 址 
8 位 


192/368 
x 











8X13 位 


堆栈 


8 位 CPU 








图 2-8 PIC16F87X 系列 单片机 内 部 机 构 


PIC16F87X 系列 单片机 主要 有 4 个 不 同型 号 : PIC16F873/874/876/877 。 

PIC16F87X 系列 的 最 高 工作 频率 可 达到 20MHz， 具 有 上 电 复 位 (Power-on Reset, POR) 
和 掉 电 锁定 复位 (Brown-out Reset) 两 种 重 置 功能 ， 以 及 上 电 定 时 器 和 品 体 振荡 启 振 定时 
器 。 除 了 一 个 看 门 狗 定 时 需 之 外 ， 另 外 还 有 三 个 定时 器 和 两 个 CCP 模块 ， 串 行 通信 模式 方 
面 共 支持 USART (通用 同步 /异步 收发 器 ) SPL 和 工 C。PIC16F87X 系列 单片机 的 寻 址 方式 
A: 直接 寻 址 、 间 接 寻 址 、 立 即 寻 址 (常数 寻 址 ) 和 相对 寻 址 。 

PIC16F87X 系列 单片机 性 能 特点 如 下 : 

1. 高 速度 

由 于 PIC 系列 单片机 所 用 的 单字 宽 周期 指令 、 哈 佛 双 总 线 和 RISC 结构 ， 其 数据 看 吐 量 
最 高 可 达 6MIPS， 即 每 秒 钟 可 执行 600 万 条 指令 ， 这 几乎 是 其 他 大 多 数 8 位 单片机 速度 的 8 
SYA 

实时 执行 对 时 间 要 求 苛刻 的 应 用 ,例如 电动 机 控制 、 高 速 WO 或 者 串 行 数据 位 流 操作 
等 , PIC 系列 单片机 可 以 提供 一 种 新 的 低 成 本 解决 方案 ,利用 PIC 高 性 能 算法 处 理 能 力 的 实 
时 性 可 以 取代 低 效率 的 存储 操作 和 精度 不 高 的 查 表 法 。 

2. RIZE 

由 于 采用 全 静态 CMOS 设计 ， 电 源 操作 能 耗 很 低 ， 但 是 非常 可 靠 。 因 为 片 内 集成 了 上 电 
复位 电路 (POR) 、 监 视 定时 器 电路 和 RC 型 振荡 器 电路 等 选择 ， 所 以 就 不 需要 增加 价格 较 
高 的 片 外 支持 的 功能 元 器 件 ， 从 而 降低 了 系统 成 本 和 系统 功 耗 。 

3. 用 户 可 选择 振荡 器 

片 内 集成 有 带 RC 型 振荡 器 的 监视 定时 器 ， 而 且 引 进 了 “用 户 可 选择 振荡 器 ”的 新 设计 
概念 ， 它 允许 用 户 在 4 种 从 0 ~20MHz 的 频率 范围 内 选择 一 种 振荡 器 形式 ， 让 忌 片 执行 指 
令 ， 以 优化 系统 的 功 耗 。 这 4 种 振荡 器 方式 是 : 低 成 本 的 RC 型 振荡 器 ，XT 型 标准 的 石英 
晶体 振荡 器 ，HS 型 高 速 石 贡品 体 振 功 器 和 LP 型 低 功 耗 低 频 石 英 唱 体 振荡 器 。 

4. 具有 程序 代码 保护 功能 

可 通过 对 片 内 EEPROM 保密 设置 进行 加 密 。 
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5. 功能 强大 的 IO 性 能 

可 以 用 来 作为 高 速 WO 控制 器 。 数 据 输入 线 允 许 有 25mA 的 倒灌 电流 ， 可 以 直接 驱动 
LED, 

6. 具有 多 种 功能 模块 

HA PWM, A/D Fie, D/A 转换 器 、 内 部 集成 的 温度 传感器 、 基 准 电源 、 振 荡 器 、 多 
路 复 用 LCD 驱动 器 、 异 步 串 行 通信 和 接口、 数据 存储 器 (EEPROM) 等 。 

7. 中 断 特性 

PIC16F87X 系列 单片机 有 中 断 功 能 ， 根 据 要 求 可 以 选用 多 个 不 同 数目 的 内 部 和 外 部 中 断 
源 。 中 断 控 制 可 以 进行 全 局 控制 和 分 别 控制 。 外 部 接口 的 中 断 优先 级 用 软件 确定 。 可 以 用 几 
个 不 同 的 中 断 源 激活 处 理 器 从 休眠 状态 中 苏醒 。 有 固定 的 中 断 开销 时 间 ， 同 步 中 断 是 3 个 周 
期 。 用 户 可 以 根据 需要 存储 /恢复 寄存 器 。 


2.4.3 单片机 C 语言 编程 


PIC16F877 单片机 支持 C 语言 编程 ， 称 之 为 PICC。C 语言 是 一 种 源 于 编写 UNIX 操作 系 
统 的 语言 ， 它 是 一 种 结构 化 的 语言 ， 可 产生 紧凑 代码 。C 语言 的 结构 是 括号 | | 而 不 是 字 
和 特殊 符号 。C 语言 可 以 进行 许多 机 器 级 函数 控制 而 不 用 汇编 语言 。 

与 汇编 语言 相 比 ， 有 如 下 优点 : 

对 单片机 的 指令 系统 不 要 求 ， 仅 要 求 对 单片机 的 存储 器 结构 有 初步 的 了 解 ; 寄存 器 分 
配 、 不 同 寄 存 器 的 寻 址 及 数据 类 型 等 细节 可 由 编译 器 管理 ; 程序 有 规范 的 结构 ， 可 分 为 不 同 
的 函数 ， 这 种 方式 可 使 程序 结构 化 ; 具有 将 可 变 的 选择 与 特殊 操作 组 合 在 一 起 的 能 力 ， 改 善 
了 程序 的 可 读 性 ; 关键 字 及 运算 函数 可 用 近似 人 的 思维 过 程 方式 使 用 ; 编程 及 程序 调试 时 间 
显 车 缩短， 从 而 提高 效率 ; 提供 的 库 包含 许多 标准 子 程序 ， 具 有 较 强 的 数据 处 理 能 力 ; 已 编 
好 程序 可 容易 地 植 入 新 程序 中 ， 因 为 它 具 有 方便 的 模块 化 编程 技术 ; C 源 程序 的 书写 格式 自 
由 度 较 高 ， 灵 活性 很 强 ， 有 较 大 的 任意 性 。 

C 语言 作为 一 种 非常 方便 的 语言 而 得 到 广泛 的 支持 ，C 语言 程序 本 身 不 依赖 于 机 器 硬件 
系统 ， 基 本 不 做 修改 就 可 以 根据 单片机 的 不 同 较 快 地 移植 过 来 。 

PIC 程序 的 编程 要 点 如 下 : 

1) C 语言 是 由 函数 构成 的 。 一 个 C 源 程 序 至 少 包 括 一 个 函数 (main 函数 )， 也 可 以 包 
含 一 个 main 函数 和 寿 干 其 他 函数 。 因 此 ， 也 数 是 C 语言 程序 的 基本 单位 。 被 调用 的 函数 可 
是 编译 需 提 供 的 库 函 数 ， 也 可 以 是 用 户 根据 需要 自己 编制 设计 的 函数 。 

2) 一 个 函数 由 两 部 分 组 成 : 函数 说 明 部 分 。 包 括 函 数 名 、 函 数 类 型 、 图 数 属性 、 函 数 
参 数 名 、 形 式 参 数 ( 形 参 ) 类 型 ， 一 个 函数 名 后 面 必 须 跟 一 个 圆 括号 ， 国 数 参数 可 以 没有 ， 
如 main () 函数 。 如 果 一 个 函数 有 多 个 大 括号 ， 则 最 外 层 的 一 对 1} 为 函数 的 范围 。 函 数 
体 一 般 包括 : 变量 定义 和 执行 部 分 ， 由 知 干 语 名 组成。 当然， 在 某 些 情 况 下 也 可 以 没有 变量 
定义 部 分 ， 甚 至 可 以 既 无 变量 定义 也 无 执行 部 分 。 

3) 一 个 C 语言 程序 总 是 从 main 函数 开始 执行 的 ， 而 不 论 main 函数 在 整个 程序 中 的 位 
置 如 何 。 

4) C 语言 程序 书写 格式 自由 ， 一 行内 可 以 写 几 个 语句 ， 一 个 语句 可 以 分 写 在 多 行 上 。 
C 语言 程序 无 行 号 。 
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5) 每 个 语句 和 数据 定义 的 最 后 必须 有 一 个 分 号 。 分 号 是 C 语句 的 必要 组 成 部 分 。 分 号 
不 可 少 ， 即 使 是 程序 中 最 后 一 个 语句 也 应 包含 分 号 。 

6) C 语言 本 身 没 有 输入 输出 语句 。 输 入 和 输出 的 操作 是 由 库 函 数 scanf 和 printf 等 函数 
来 完成 的 。C 对 输入 输出 实行 “函数 行 ”。 

7) 可以 用 /* ”*/ 对 C 程序 中 的 任何 部 分 作 注 释 。 一 个 好 的 、 有 使 用 价值 的 源 程 序 者 
应 当 加 上 必要 的 注释 ， 以 增加 程序 的 可 读 性 。 


2.5 机 器 人 控制 器 的 发 展 趋势 


随 着 现代 科学 技术 的 飞速 发 展 和 社会 的 进步 ， 对 机 器 人 的 性 能 提出 更 高 的 要 求 。 智 能 机 
器 人 技术 的 研究 已 成 为 机 器 人 领域 的 主要 发 展 方向 ， 如 各 种 精密 装配 机 器 人 、 力 /位 置 混 合 
控制 机 器 人 、 多 肢体 协调 控制 系统 以 及 先进 制造 系统 中 的 机 器 人 的 研究 等 。 相 应 地 ， 对 机 如 
人 控制 器 的 性 能 也 提出 了 更 高 的 要 求 。 

但 是 ， 机 器 人 自 诞 生 以 来 ， 特 别 是 工业 机 器 人 所 采用 的 控制 器 基本 上 都 是 开发 者 基于 自 
己 的 独立 结构 进行 开发 的 ， 采 用 专用 计算 机 、 专 用 机 器 人 语言 、 专 用 操作 系统 、 专 用 微 处 理 
器 。 这 样 的 机 器 人 控制 器 已 不 能 满足 现代 工业 发 展 的 要 求 。 

从 前 面 提 到 的 两 类 机 融 人 控制 需 来 看 ， 串 行 处 理 结 构 控 制 器 的 结构 封 用 ， 功 能 单一 ， 且 
计算 能 力 差 ， 难以 保证 实时 控制 的 要 求 ， 所 以 目前 绝 大 多 数 商 用 机 器 人 都 是 采用 单 轴 PID 控 
制 ， 但 也 难以 满足 机 器 人 控制 的 高 速 、 高 精度 的 要 求 。 虽 然 分 布 式 结构 在 一 定 层次 上 是 开放 
的 ， 可 以 根据 需要 增加 更 多 的 处 理 咒 ， 以 满足 传 感 咒 处 理 和 通信 的 需要 ， 但 它 只 是 在 有 限 范 
围 内 开放 。 

并 行 处 理 结构 控制 器 虽然 能 从 计算 速度 上 有 了 很 大 突破 ， 能 保证 实时 控制 的 需要 ， 但 
必须 看 到 还 存在 许多 问题 。 目 前 的 并 行 处 理 控 制 器 研究 一 般 集 中 于 机 器 人 运动 学 、 动 力 
学 模型 的 并 行 处 理 方面 ， 是 基于 并 行 算 法 和 多 处 理 器 结构 的 映射 特征 来 设计 的 ， 即 通过 
分 解 给 定 任务 ， 得 到 若干 子 任务 ， 列 出 数据 相关 流 图 ， 实 现 各 子 任务 在 对 应 处 理 器 上 的 
并 行 处 理 。 由 于 并 行 算法 中 通信 、 同 步 等 内 在 特点 ， 如 程序 设计 不 当 ， 则 易 出 现 锁 死 与 
通信 堵塞 等 现象 。 

随 着 机 器 人 控制 技术 的 发 展 ， 针 对 结构 封闭 的 机 器 人 控制 器 的 缺陷 ， 开 发 “具有 开放 
式 结构 的 模块 化 、 标 准 化 机 器 人 控制 器 ”是 当前 机 器 人 控制 器 的 一 个 发 展 方向 。 近 几 年 ， 
日 本 、 美 国 和 欧洲 一 些 国家 都 在 开发 具有 开放 式 结构 的 机 咒 人 控制 器 ， 如 日 本 安 川 公司 基于 
PC 开发 的 具有 开放 式 结构 、 网 络 功能 的 机 器 人 控制 器 。 我 国 863 计划 中 智能 机 器 人 主题 也 
已 对 这 方面 的 研究 立项 。 

开放 式 结 构 机 器 人 控制 器 是 指 : 控制 器 设计 的 各 个 层次 对 用 户 开 放 ， 用 户 可 以 方便 地 扩 
展 和 改进 其 性 能 。 其 主要 思想 是 : 

1) 利用 基于 非 封 朵 式 计算 机 平台 的 开发 系统 ， 如 Sun、SCI、PC s。 有 效 利 用 标准 计算 
机 平台 的 软 、 硬 件 资源 为 控制 器 扩展 创造 条 件 。 

2) 利用 标准 的 操作 系统 (如 Unix, Vxwork) 和 标准 的 控制 语言 (如 C、C ++)， 从 而 
可 以 改变 各 种 专用 机 器 人 语言 并 存 且 互 不 兼容 的 局 面 。 

3) 采用 标准 总 线 结 构 ， 使 得 为 扩展 控制 器 性 能 而 必需 的 硬件 〈 如 各 种 传感器 、LO 板 、 
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运动 控制 板 )， 可 以 很 容易 地 集成 到 原 系统 中 。 

4) 利用 网 络 通信 ， 实 现 资源 共享 或 远程 通信 。 目 前 ， 儿 乎 所 有 的 控制 器 都 没有 网 络 功 
能 ， 利 用 网 络 通信 功能 可 以 提高 系统 变化 的 柔性 。 

我 们 可 以 根据 上 述 思想 设计 具有 开放 式 结构 的 机 器 人 控制 器 。 而 且 设计 过 程 中 要 尽 可 能 
做 到 模块 化 。 模 块 化 是 系统 设计 和 建立 的 一 种 现代 方法 ， 按 模块 化 方法 设计 ， 系 统 由 多 种 功 
能 模块 组 成 ， 各 模块 完整 而 单一 。 这 样 建立 起 来 的 系统 ， 不 仅 性 能 好 、 开 发 周期 短 而 且 成 本 
较 低 。 模 块 化 还 使 系统 开放 ， 易 于 修改 、 重 构 和 添加 配置 功能 。 

新 型 的 机 器 人 控制 器 应 有 以 下 特色 : 

(1) 开放 式 系 统 结构 ”采用 开放 式 软件 、 硬 件 结构 ， 可 以 根据 需要 方便 地 扩充 功能 ， 
使 其 适用 于 不 同类 型 机 器 人 或 机 器 人 化 自动 生产 线 。 

(2) 合理 的 模块 化 设计 “对 硬件 来 说 ， 根 据 系统 要 求 和 电气 特性 ， 按 模块 化 设计 ， 这 不 
仅 方 便 安 装 和 维护 ， 而 且 提 高 了 系统 的 可 靠 性 ， 系 统 结构 也 更 为 紧凑 。 

(3) 有 效 的 任务 划分 “不同 的 子 任务 由 不 同 的 功能 模块 实现 ， 以 利于 修改 、 添 加 、 配 置 
功能 。 

(4) 实时 性 、 多 任务 要 求 ” 机 器 人 控制 器 必须 能 在 确定 的 时 间 内 完成 对 外 部 中 断 的 处 
理 ， 并 且 可 以 使 多 个 任务 同时 进行 。 

(5) 网 络 通信 功能 “利用 网 络 通信 的 功能 ， 以 便于 实现 资源 共享 或 多 台 机 器 人 协同 工 
作 。 

(6) 形象 直观 的 人 机 接口 “另外 ， 机 器 人 控制 器 中 ， 和 运动 控 制 板 是 必 不 可 少 的 。 由 于 
机 器 人 性 能 的 不 同 ， 对 运动 控制 板 的 要 求 也 不 同 。 美 国 Delta Tau 公司 推出 的 PMAC (Pro- 
grammable Multi-axies Controller) 在 国内 外 引起 重视 。PMAC 是 一 种 功能 强大 的 运动 控制 器 ， 
它 全 面 地 开发 了 DSP 技术 的 强大 功能 ， 为 用 户 提供 了 很 强 的 功能 和 很 大 的 灵活 性 。 借 助 于 
Motorola 公司 的 DSP56001 数字 信和 号 处 理 器 ，PMAC 可 以 同时 操纵 1 ~8 轴 ， 比 起 其 他 运动 控 
制 板 来 说 ， 有 很 多 可 取 之 处 。 

由 于 适用 于 机 器 人 控制 的 软 、 硬 件 种 类 繁多 和 现代 技术 的 飞速 发 展 ， 开 发 一 个 结构 完全 
开放 的 标准 化 机 器 人 控制 器 存在 一 定 困难 ， 但 应 用 现 有 技术 ， 如 工业 PC 良好 的 开放 性 、 安 
全 性 和 联网 性 ， 标 准 的 实时 多 任务 操作 系统 ， 标 准 的 总 线 结构 ， 标 准 接口 等 ， 打 破 现 有 机 器 
人 控制 器 结构 封闭 的 局 面 ， 开 发 开放 性 结构 、 功 能 模块 化 的 标准 化 机 器 人 控制 器 是 完全 可 行 
的 。 

随 着 机 器 人 技术 的 发 展 ， 机 器 人 应 用 领域 的 不 断 扩 大 ， 对 机 器 人 的 性 能 提出 了 更 高 的 要 
求 ， 因 此 ， 如 何 有 效 地 将 其 他 领域 (如 图 像 处理 、 声 音 识 别 、 最 优 控制 、 人 工 智能 等 ) 的 
研究 成 果 应 用 到 机 器 人 控制 系统 的 实时 操作 中 ， 是 一 项 富有 挑战 性 的 研究 工作 。 而 具有 开放 
式 结构 的 模块 化 、 标 准 化 机 器 人 控制 器 的 研究 无 疑 对 提高 机 器 人 性 能 和 自主 能 力 、 推 动机 器 
人 技术 的 发 展 具 有 重大 意义 。 
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PI ARMA A EK PE IE R ER 


上 一 章 介绍 了 竞赛 机 器 人 平台 的 核心 单元 一 一 控制 器 ， 控 制 器 是 机 器 人 的 “大 脑 ”， 负 
责 对 外 界 信息 进行 处 理 ， 并 且 做 出 下 一 步 的 决策 。 大 脑 要 工作 自然 离 不 开 它 的 载体 ， 同 样 控 
制 锅 也 需要 有 一 个 可 以 运行 承载 的 环境 ， 这 个 环境 就 是 控制 器 的 软件 开发 平台 。 为 了 更 好 地 
理解 什么 是 软件 开发 平台 ， 我 们 看 一 个 例子 : 在 邮局 ， 工 作 人 员 把 信件 按照 收 信人 的 地 址 分 
类 一 一 寄 往 北京 的 信件 放 入 一 号 箱子 、 寄 往 天 津 的 信件 放 入 二 号 箱子 、 寄 往 上 海 的 信件 放 入 
三 号 箱子 一 一 这 个 分 类 的 规则 由 邮局 的 管理 者 制定 ， 通 常 这 个 规则 要 用 汉字 书写 ， 要 写 在 纸 
上 ， 并 经 过 反复 思考 修改 ， 最 后 告知 工作 人 员 。 同 样 ， 机 器 人 也 需要 一 套 规则 一 一 什么 时 候 
前 进 、 什 么 时 候 转 向 、 什 么 时 候 后 退 ， 这 套 规 则 由 机 器 人 的 开发 人 员 制 定 ， 通 常 这 套 规 则 是 
用 C 语言 、 汇 编 语言 等 编程 语言 制定 的 ， 利 用 软件 开发 平台 书写 程序 ， 并 要 在 软件 开发 平 
台 上 经 过 反复 修改 调试 ， 之 后 ， 软 件 开发 平台 中 的 编译 器 将 C 语言 或 者 汇编 语言 转换 成 机 
髓 语言 ， 告 知 控制 侨 。 基 于 这 个 软件 开发 平台 进行 软件 编程 是 竞赛 机 器 人 技术 开发 的 主要 内 
容 。 在 这 个 环境 下 ， 才 能 够 进行 对 硬件 的 编程 操作 ， 才 能 实现 竞赛 机 器 人 “大 脑 ” 的 功能 。 
下 面 就 来 介绍 一 下 这 个 软件 开发 平台 一 一 MPLAB 。 



































3.1 MPLAB 概述 


MPLAB 是 适用 于 Microchip Technology 公司 PIC16/17 系列 单片机 的 、 基 于 Windows 的 、 
易学 易 用 的 集成 开发 环境 (Integrated Development Environment ，IDE ) 。 这 种 集成 开发 环境 可 
以 方便 又 灵活 地 编辑 、 汇 编 、 仿 真 、 开 发 和 调试 查 错 。 


3.1.1 MPLAB 集成 开发 环境 的 组 成 


MPLAB 集成 开发 环境 软件 集成 了 下 列 开 发 工具 ; 

1. 工程 项 目 管理 程序 (Project Manager) 

工程 项 目 管理 程序 用 于 创建 工程 项 目 ， 并 用 指定 的 与 工程 项 目 有 关 的 文件 工作 。 
MPLAB 工程 项 目 管理 程序 也 使 操作 者 能 通过 单 击 鼠标 建立 应 用 程序 ， 并 把 代码 下 载 到 仿真 
器 或 模拟 程序 中 。 

通过 建立 工程 项 目 可 以 实现 符号 调试 (Symboic Debugging) 。 工 程 项 目 管理 程序 是 
MPLAB 的 核心 部 分 。 不 创建 工程 项 目 就 不 能 进行 符号 调试 。 要 进行 源 代码 符号 调试 需要 进 
行 下 列 操作 : 

1) 倒 建 工程 項目 : 

2) 把 源 代码 文件 加 入 到 工程 项 目 之 中 ; 

3) 汇编 或 编译 源 代码 ; 

4) 编辑 源 代 码 ; 

5) 重建 (Rebuild) 所 有 源 文件 ， 或 编译 单个 文件 ; 
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6) 调试 源 代码 。 

2. MPLAB 编辑 程序 (MPLAB Editor) 

MPLAB 编辑 程序 用 于 编写 录 和 人 和 编辑 应 用 程序 源 文件 ， 或 其 他 用 于 PIC16/17 单片机 控 
if ait AY SCAN SCF 

3. MPASM 汇编 程序 (MPASM Assembler ) 

MPASM 通用 PIC16/17 单片机 汇编 程序 ， 可 以 提供 完善 的 宏 调用 功能 、 条 件 汇 编 以 及 几 
种 不 同 的 源 文件 与 列表 文件 格式 。 在 使 用 MPASM 过 程 中 ,不 退出 MPLAB, 便 可 生成 各 种 目 
标 代码 ， 以 支持 Microchip 开发 工具 与 其 他 编辑 工具 。 

4. MPLAB-SIM 软件 模拟 程序 (MPLAB-SIM Software Simulator ) 

MPLAB-SIM 软件 模拟 程序 可 以 提供 模拟 PIC16/17 单片机 的 指令 执行 和 输入 /输出 的 环 
境 ， 不 需要 任何 硬件 ， 在 PC 上 就 可 以 用 软件 仿真 全 系列 单片机 ， 对 用 户 应 用 系统 程序 的 逻 
辑 进 行 调试 ， 查 找 代 码 错 误 。 这 是 一 种 非 实 时 、 非 在 线 的 软件 模拟 器 ， 对 于 那些 实时 性 要 求 
不 高 的 程序 ， 采 用 这 种 方法 调试 可 以 降低 开发 成 本 。 

5. PICMASTER 硬件 在 线 仿真 器 (PICMASTER Emulator) 

PICMASTER 硬件 仿真 器 是 高 性 能 的 在 线 仿 真 器 。 对 于 有 实时 性 要 求 的 系统 就 必须 使 用 
这 种 硬件 在 线 仿真 器 进行 调试 。 

6. 其 他 工具 

MPLAB IDE 支持 Microchip 开发 工具 以 及 其 他 开发 工具 ， 诸 如 编程 器 、 编 译 程序 以 及 其 
他 可 用 产品 。 

MPLAB 工具 是 按 功能 组 织 的 ， 这 有 助 于 很 容易 地 找到 下 拉 式 选单 以 及 可 定制 的 快捷 键 
并 使 用 它们 。MPLAB 工具 可 以 用 于 调试 源 程序 代码 ， 在 编辑 源 文件 时 可 以 自动 查 错 ， 用 基 
于 内 部 寄存 器 值 的 断 点 进行 调试 ， 用 模拟 程序 检查 程序 流程 或 用 PICMASTER 硬件 在 线 仿真 
器 进行 时 序 检查 ， 可 以 在 不 同窗 口内 跟踪 变量 的 值 ， 并 随时 可 从 MPLAB 在 线 帮助 中 快速 地 
找到 问题 的 解决 方法 。 


3.1.2 MPLAB 运用 方式 












































MPLAB 可 在 三 种 不 同方 式 下 运行 : 

1. MPLAB-SIM 软件 模拟 程序 方式 (MPLAB-SIM Simulator Mode) 

在 这 种 方式 下 ， 提 供用 于 调试 应 用 系统 设计 源 程 序 的 快速 工具 。 

2. 编辑 程序 方式 

不 用 软件 模拟 程序 或 硬件 仿真 器 便 可 编写 、 编 译 /汇编 等 ， 并 能 从 源 代 码 中 删除 错误 。 

3. PICMASTER 硬件 在 线 仿真 器 方式 

能 用 PICMASTER 硬件 在 线 仿真 器 实时 运行 用 户 应 用 系统 的 目标 程序 ， 同 时 还 可 以 对 便 
件 进 行 调试 。 
3.1.3 MPLAB 对 硬件 与 软件 的 要 求 


在 Windows 操作 环境 下 ， 利 用 其 多 任务 特性 可 以 同时 运行 多 个 程序 ， 例 如 E-mail、 电 子 
表格 以 及 MPLAB IDE 等 。 因 为 MPLAB IDE 具有 多 处 理 器 仿真 能 力 ， 并 用 客户 机 程序 支持 动 
态 数据 交换 (Dynamic Data Exchange，DDE) ， 所 以 由 MPLAB IDE 所 采集 的 数据 可 被 其 他 程 
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Fe (例如 Microsoft Excel) 所 共享 。 

如 果 要 求 利 用 仿真 器 系统 的 特性 ， 安 装 MPLAB 软件 (MPLAB. EXE) 所 需要 的 PC 系统 
最 小 配置 要 求 如 下 : 

1) 386 或 以 上 档次 的 处 理 器 的 个 人 计算 机 ， 推 荐 CPU 使 用 奔腾 处 理 器 ; 

2) 4MB 内 存 可 用 ， 推 荐 LOMB 以上 内 存 : 

3) VGA (视频 图 形 阵列 ) 或 Super VGA Sha dt; 

4) Microsoft Windows 3. 1 或 以 上 版本 。 


3.2 MPLAB 的 安装 和 启动 


3.2.1 完整 的 MPLAB 安装 


在 MPLAB Setup 开始 复制 文件 之 前 ， 它 将 进行 检查 ， 以 确保 所 选 驱动 咒 具 有 可 供 
MPLAB 安装 用 的 空间 。 在 完整 的 安装 中 ，MPLAB Setup 将 安装 以 下 一 些 应 用 程序 ， 

1) MPLAB 程序 文件 〈 包 括 编辑 程序 ) ; 

2) MPLAB—SIM ; 

3) 工具 (MPASM for Windows) ; 

4) 帮助 (Help). 

详细 安装 过 程 请 参见 第 8 章 实验 一 。 


3.2.2 MPLAB 的 启动 


MPLAB 可 以 用 以 下 几 种 不 同方 式 启动 : 

1) 用 鼠标 双击 Microsoft MPLAB 程序 组 内 的 图 标 ; 

2) 用 鼠标 单 击 Windows 中 File っ Run 命令 ; 

3) 通过 其 他 任何 可 启动 该 程序 的 应 用 程序 ; 

4) 在 MPLAB 命令 行 中 列 出 包含 MPLAB 将 要 打开 的 文本 文件 。MPLAB 编辑 程序 
(MPLAB Editor) 将 打开 在 命令 行 上 所 列 出 的 每 一 个 文件 。 命 令 行 上 给 出 的 文件 名 允许 包括 
常用 的 DOS 通配符 。 














3.3 MPLAB 的 使 用 


3.3.1 启动 MPLAB IDE 


以 使 用 C 语言 为 例 ， 用 以 下 任意 一 种 方式 启动 软件 : 

1) 选择 “开始 一 所 有 程序 -Microchip MPLAB IDE- っ MPLAB IDE” ; 
2) 双击 桌面 上 的 MPLAB IDE 图 标 。 

MPLAB IDE 桌面 显示 如 图 3-1 所 示 。 
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Faass Contre) Find in Files 














图 3-1 MPLAB IDE 启动 桌面 


3.3.2 创建 源 文 件 
选择 File (文件 ) new (新 建 ) ， 出 现 一 个 文本 编辑 窗口 ， 在 该 窗口 中 输入 C 语言 源 
程序 ， 如 图 3-2 所 示 。 


S EPLAB IDE v6.62 
File Edit View Project Debugger Programmer Tools 


| Dee) tee SH?) tae Sw | Checksum: Ox0fcf 





Configure Window Help 





Mi Untitled ... |- | 口 | X| 


HE Output 





|Build | Version Control) Find in Files 





| Untitled* 


AMBAR: interrupt www t); 
PRE: 
BEX: 产生 T0 中 断后 全 局 时 间 变 量 time 自 加 1 
ARERERERERAEAEEATEAE RASA RERE NERA EERE EE RAEARAAEAAAAA REDE AERA EERE AEE AERA / 
void interrupt woul (){ Af/ 中 断 的 唯一 入 口 
if(TOIF) 

{ 








timett; 
stimett; 
TOIF=0; 


} 
zdan PUT AR S FARE 
if (ADIF) 








ff 请 降 中 断 标 志 
/7 启动 下 一 次 &7D 转 换 


ff PPRERRREAEREA EERE EREE ERR E EEE EERERE REED RERERREER LEED REEAE REDE REDE REEA EERE A A 


74 下 面 葬 断 是 否 有 键 按 下 和 松 开 的 程序 
void key _push_dt) 





{ 
fee BSP 
if(D_FORWARD==1) { 
delay (1000) ; f/VATSE 
if (D_FORWARD==1} { z7 再 次 判断 
while (D_FORWARD==1); 〆 等 待 松井 
start _flag=!start flag; 


た エエ エエ エエ エエ エエ エエ エエ エエ エエ エエ エエ エネ エエ エエ エエ エエ エエ エエ エエ エエ エキ エエ エ エギ エエ そ エエ エエ キテ エキ キキ エエ エエ エメ テキ キナ テキ エエ 


{HEIR RAE 
回 | mit | 











_PICIBFSTTA Wo [z dec bank O Ln 173, Col | INS WR 


图 3-2 输入 C 语言 源 程 序 的 窗口 


先 创 建文 件 夹 ， 名 字 可 以 任意 取 ， 但 是 不 要 有 汉字 ， 这 里 以 取 名 为 MyPrj 为 例 ， 然 后 将 
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上 面 输入 的 源 程序 保存 该 文件 夹 ， 注 意 文 件 的 扩展 名 为 ,ce， 这 里 将 它 保存 为 examl.c, 如 
图 3-3 所 示 。 


BEED: | myfri a o t e 





IHF H): exami. c RF E) 
EITEM (T): |C Source Files (*.c:*. h) ha 


Encoding: ANSI w 














图 3-3 ”另存 为 对 话 杠 
文件 保存 后 ， 源 程序 编辑 窗口 中 的 语句 被 着 上 了 各 种 颜色 ， 这 些 颜 色 能 帮助 我 们 更 好 地 
阅读 源 程序 ， 快 速 发 现 输入 有 误 的 指令 ， 如 图 34 所 示 。 


® EPLAB IDE v6.62 


BEE 





File Edit View Froject Debugger Programmer Toci- Configure Window Help 
| Dee :eea\Sa? | ci oo lh ows | Checksum: Ox0fcf 


M Untitled .. |- | コロ x] 





| Output 


[Build | Version Control| Find in Files 








| C:\8yPrj\exanl.c 


} 
た ドド エキ キャ ヤキ マヤ ドド ヤギ キマ マヤ ヤキ エマ キャド エギ キャイ ャ キャイ ャ キャ キャ キャ ャ エエ エマ キャ エイ ギド ャ ヤギ エキ ャ エマ ャ キテ 
// PRIS Ge Ft ee 
void key push ql) 
{ 
(EOD RST 
if (D_FORWARD==1) { 
delay (1000) ; fade 
if (D_FORWARD==1) { 六 再 次 判断 
while (D_FORWARD==1} ; PSA 
start_flag=!start_flag, 


} 
+ 
りな エエ エエ エナ エ エエ エキ エキ エ エナ エギ エナ エエ エエ エナ キナ デ エ エエ エエ エナ エ キャ エエ エド エエ キナ エキ エエ エエ キナ エ ザキ エエ エギ エエ ナ エエ ナ キャ エナ テキ すす 
/1 还 控 小 车 程序 
void telecontroli) 
{ 
if((D_FORWARD == 1) ss {B_LEFT == 1)) motor _forward_left() ; 
else if | (D_FORWARD l) && (A_RIGHT == 1)) motor_forward_right |); 
else if((C_STOP == 1) sg (B_LEFT ==1 }} motor backward left |) = 
else if((C_STOP == 1) cs tA RIGHT == 1)) motor backward right!) = 
else if | (D_FORWARD 1) 4&6 (B _ LEFT == 0) && (A_RIGHT == 0)) motor_fo 
else if((C_STOP == lice (B LEFT == 0) gg (A RIGHT == 0)) motor ba 
else if((B_LEFT == 1) ca (C_STOP == 0) && (D_FORWARD == 0)) motor_lefti) 
else if((A RIGHT == 1} && (C_STOP == 0) sg (D_FORWARD == 0)) motor ri 
else motor_stop(); 
} 


が さま 本 本 まさ よさ まま ます ます さよ さま さま さよ 本 よ を よさ まさ ささ ます ます を よ すま よ すま を さよ さよ ます な さま ささ を まま さま よさ よ を を さま まま まま すま アア 


void main () {fusing REG, SPCR PYAR naina ge 











FITC1BFBTTA #:0 zde c bank O In 173, Col ] INS "R 


图 34 着 色 后 的 语句 窗口 
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3.3.3 创建 项 目 
选择 Project( 項目 ) っ new( 新 建 ) , 出現 New Project( 新 项 目 ) 对 话 框 ， 如 图 3-5 所 示 。 


Hew Project 


Project Name 


Project Directory 


图 3-5 New Project (新 项 目 ) 对 话 框 











在 New Project ( 新 項目 ) 对 话 框 中 ， 我 们 将 这 个 示例 项 目 命名 为 mypr ,使 用 “Browse” 
按钮 ， 将 项 目 放 在 名 为 ec: \MyPrj 的 文件 夹 中 。 单 击 “OK” 按 钮 ， 在 MPLAB IDE 界面 上 会 看 
到 已 创建 项 目的 项 目 窗口 ， 如 图 3-6 所 示 ， 如 果 项 目 窗口 未 打开 ， 请 选择 View 一 Project。 


E myprj-. mcp 
; Source Files 
Header Files 
Object Files 
i- Library Files 
i Other Files 





图 3-6 项 目 窗口 


3.3.4 给 项 目 添加 文件 


源 文件 是 必须 添加 的 。 其 他 文件 ， 如 头 文 件 、 库 文件 、 链 接 描 述 文件 ， 视 项 目的 具体 情 
况 可 加 可 不 加 。 在 本 例 中 ， 只 添加 一 个 源 文件 examl. e， 在 左边 的 项 目 窗口 中 找到 Source 
Files， 在 其 上 用 鼠标 右键 单 击 ， 在 弹出 的 快捷 菜单 中 选 Add Files， 如 图 3-7 所 示 。 
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mm EPLAB IDE v6.62 


File Edit View Froject Debugger Programmer sols Configure Window Help 








Mayprj-ace 所 回 区 








图 3-7 在 项 目 窗口 添加 源 文件 


双击 要 添加 的 文件 examl. ce， 或 单 击 要 添加 的 文件 examl. ec， 然后 单 击 “ 打 开 ” 按 钮 ， 
如 图 3-8 所 示 。 


Add Files to Project 


sraao: [Dm | OP 


四 
sea 


图 3-8 添加 的 文件 对 话 杠 
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文件 添加 成 功 后 的 项 目 窗口 的 Source Files 下 已 经 添加 了 文件 examl. c, WA 3-9 所 示 。 
| | 


E =yprj.acp* 
(=); Source Files 
i examl. ce 
i Header Files 
Object Files 
Library Files 
-Other Files 





图 3-9 已 添加 文件 后 的 项 目 窗口 
3.3.5 选择 器 件 
选择 Configure—Select Device 后 会 弹出 Select Device 对 话 框 ， 单 击 Device 栏 右边 的 下 拉 
箭头 ， 在 下 拉 菜 单 中 既 含有 PIC16F877 又 含有 PIC16F877A ， 在 本 书 中 使 用 的 是 PIC16F877A 
芯片 ， 一 定 要 选择 器 件 PIC16F877A! (提醒 : PIC16F877A 与 PIC16F877 是 两 个 内 部 结构 不 
Select Device 


Device: 
PICT BFS? FA w 





Microchip Programmer Tool Support 


O PICSTART Plus O MPLAB ICD 2 
O PRO MATE II @ FICkit 1 
O MPLAB PM3 


Microchip Debugger Tool Support 
Ci MPLAB SIM 『 MPLAB ICD 2 


MPLAB ICE 2000 MPLAB ICE 4000 


COPCM1Bx¥O @No Module 


图 3-10 ”选择 事件 窗口 
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同 的 芯片 ， 两 个 芯片 不 能 直接 相互 替换 ， 所 以 千 万 不 要 误 选 成 PIC16F877 ) ， 在 Microchip 
Programmer Tool Support 部 分 中 , MPLAB ICD 2 旁边 的 “ 灯 ” 图 标 应 为 绿色 ， 如 图 3-10 所 
示 。 选 择 完 毕 后 ， 单 击 “OK” 按 钮 。 

说 明 : MPLAB ICD 2 支持 的 器 件 会 在 Microchip Programmer Tool Support 下 MPLAB ICD 2 
SAT “BRIT” Klin. ASCH a PUA ZEIT” lon. m “ee AT” lope a] 
以 选择 这 个 器 件 ， 但 可 能 有 某 些 限制 ， 可 能 不 适 于 量 产 ， 但 它 可 以 让 MPLAB ICD 2 做 试用 。 


3.3.6 设置 配置 位 


设置 要 下 载 到 器 件 中 的 配置 位 ， 选 择 Configure—Configuration Bits。 通 过 单 击 “Settings” 
栏 中 的 文本 ， 可 以 更 改 这 些 配 置 位 ， 如 图 3-11 所 示 。 

Oscillatot: 振荡 方式 选择 ， 这 取决 于 目标 板 上 的 晶体 振荡 器 。 

Watchdog Timer; 看 门 狗 定 时 器 使 能 位 ， 视 是 否 使 用 看 门 狗 而 定 ， 如 果 使 用 了 看 门 狗 则 
选 为 on， 未 使 用 则 选择 Off. 

Power Up Timer; 上 电 延 时 使 能 位 ， 一 般 选 择 为 on， 以 有 利于 芯片 起 振 ， 也 可 以 选 Off。 

Brown Out Detect: 掉 电 检 测 使 能 位 ，ICD2 作 调 试 工 具 时 ， 一 定 要 选择 为 Off。 

Low Voltage Program: 低压 编程 使 能 ， 必 须 选 择 为 Off。 

Flash Program Write: 写 Flash 使 能 ， 选 择 为 Write Protection Off ( 写 保 护 关 闭 ) 。 

Data EE Read Protect: 读 内 部 EEPROM 保护 位 ， 用 ICD2 作 调 试 工具 时 ， 一 定 要 选择 为 
Off, 

Code Protect; 加 密 位 ， 用 ICD2 作 调 试 工具 时 一 定 要 选择 为 Off。 





Configuration Bits 


Address Category setting 
2007 Oscillator HS 
Watchdog Timer ort 
Power Up Timer Off 
Brown Out Detect oft 
Low Voltage Program Disabled 
Flash Program Write Write Protection Off 
Data EE Read Protect Ort 
Code Protect ort 








图 3-11 配置 位 窗口 
3.3.7 选择 MPLAB ICD2 作为 调试 器 


选择 Debugger—Select Tool 一 MPLAB IDE2 。 调 试 器 菜单 将 会 显示 可 供 使 用 的 其 他 调试 选 
项 。 同 时 ， 输 出 窗口 会 打开 显示 连接 信息 。 如 果 MPLAB IDE 在 启动 时 试图 连接 到 MPLAB 
ICD2， 但 因为 USB (通用 串 行 总 线 ) 端口 或 一 个 非 COM1 的 COM 端口 被 使 用 而 失败 ， 那 么 
允许 失败 ， 继 续 第 二 步 的 通信 端口 设置 。 

注意 : MPLAB ICD2 作为 调试 工具 时 所 下 载 的 程序 只 能 用 于 仿真 调试 ， 不 能 够 离线 使 
用 ， 若 要 下 载 能 离线 使 用 的 程序 ， 就 要 选择 Programmerr—Select Programmer—>MPLAB ICD2 ， 
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将 MPLAB ICD2 作为 编程 工具 ， 如 图 3-12 所 示 。 


W EPLAB IDE v6.62 — [Output] 


T] File Edit View Project ROTEEGE Programmer Tool Configure Window Help 








+ Hone 

， 
2 MPLAB IC 0 
3 MPLAB SIM 
4 MPLAB ICE 2000 





Bun 
|Build | Version Control EH Animate 
Connecting to MPLAB ICD 2 {elt 
- . . Connected Step Into 
Setting Vdd source to tay Step Over 
Target Device PICIGF&TT £ Step Out 
-.. Reading ICD Product ID Reset 
Running ICD Self Test a 
...Passed Ercakpoints:..: 
IPLAB ICD 2 Ready Advanced Breakpoints 
MPLAB ICD 2 Setup Wizard... 


























Download ICI2 Operating System 








Settings... 














3-12 JERE MPLAB ICD2 作为 调试 器 窗口 
3.3.8 通过 向 导 完 成 调试 器 的 设置 
选择 Debugger—MPLAB ICD2 Setup Wizard, Ja ay ICD2 调试 器 设置 向 导 ， 如 图 3-13 所 
示 。 
EFLAK ICD 2 Setup Wizard 


Welcome! 


This wizard helps you set up the MPLAB ICD 2. 


To continue, click Next. 








图 3-13 ”调试 器 设置 向 导 
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选择 USB 或 COM 端口 / 波 特 率 。 因 为 我 们 使 用 的 “MPLAB ICD2 仿真 下 载 器 ”为 USB 
接口 ，COM 串 行 端口 数据 传输 太 慢 ， 因 此 通信 端口 选 USB 即 可 ， 当 然 还 要 看 MPLAB ICD2 
仿真 下 载 器 上 提供 什么 接口 ， 如 果 USB 和 COM 端口 都 有 ， 则 建议 使 用 USB 端口 ， 如 图 3-14 
所 示 。 
KELAK ICD 2 Setup Fizard 


Step One: 
Select a communications method. 


Com Part Baud Rate 


ay) oo yl 





图 3-14 ”端口 / 波 特 率 选择 窗口 





确定 是 否 由 “MPLAB ICD2 仿真 下 载 器 ”对 实验 板 供电 。 由 “MPLAB ICD2 仿 真 下 载 
器 ”向 目标 板 供电 ， 则 选中 “Power target from the MPLAB ICD2”; 由 独立 的 电源 向 目标 板 供 
电 ， 则 选中 “Target has own power supply”， 如 图 3-15 所 示 。 

自动 连接 前 面 最 好 打上 钩 ， 这 样 不 用 手动 连接 ， 比 较 方 便 ， 如 图 3-16 所 示 。 

自动 下 载 OS (操作 系统 ) 前 面 最 好 打上 钩 ， 这 样 不 用 手动 下 载 OS (操作 系统 )， 比较 
方便 ， 如 图 3-17 所 示 。 

最 后 出 现 完成 窗口 ， 如 图 3-18 所 示 。 查 看 设置 无 误 后 ， 单 击 “ 完 成 ”按钮 ， 奉 发 现 有 
错误 ， 则 可 单 击 “ 上 一 步 ” 按 钮 ， 退 回 重新 设置 。 


3.3.9 建立 PC 5 MPLAB ICD2 仿真 下 载 器 之 间 的 通信 联系 


手动 连接 : 选择 Debugger—>Connect, 连接 到 MPLAB ICD 2, 

自动 连接 : 如 果 ICD 2 设置 中 选择 了 “Automatically connect at startup”， 那 么 系统 会 自 
动 连接 ， 输 出 窗口 提示 “…Connected”， 并 且 没 有 出 现 红 色 的 警告 或 错误 信息 ， 表 示 已 经 正 
常 连 接 ， 如 图 3-19 所 示 。 
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EPLAG ICD 2 Setup Wizard 


Step Tro: 


Select target power source 


©) Target has own power supply 


Note: Ifyou wish to power your application from the MPLAB ICD 2, then the MPLAB ICD 2 
must be powered with an independent power supply. [MPLAB ICD 2 can not draw enough 
power from the USB cable to program the target. | 


See the MPLAB ICD 2 Users Manual for more details. 


图 3-15 供电 选择 窗口 
NFLAB ICD 2 Setup Wizard 


Step Three: 
Enable auto-conmection. 


Would you like MPLAB IDE to automatically connect to the MPLAB ICD 2 on start up? 
If enabled, MPLAB IDE conveniently connects to the MPLAB ICD 2 at project startup. 


If disabled, MPLAB IDE waits until the user initiates a connect operation before attempting 
to communicate with the MPLAB ICD 2. 


Note: The potential downside to enabling auto connection is that MPLAB IDE will always 
attempt to communicate with the MPLAB ICD 2 on project startup. If there is a device 
other than the MPLAB ICD 2 on the selected communications channel it might be 
damaged by this attempted communication. 


图 3-16 自动 连接 询问 窗口 


EPLAG ICD 2 Setup Wizard 


Step Four: 
Enable auto-download of operating systems. 


Would you like MPLAB IDE to automatically download [without prompting) MPLAB ICD 2 
operating systems when needed? 


The MPLAB ICD 2 uses different operating systems for different target families. 


If enabled, MPLAB ICD 2 will automatically download the appropriate operating system 


whenever it detects that the operating system currently residing within the MPLAB ICD 2 ts 
not the corect one for the selected target device, or whenever MPLAB IDE detects a 
newer version of the operating system on the users computer. 


lf disabled, MPLAB ICD 2 will prompt the user for permission to download before actually 
downloading. 





图 3-17 Bab Fak OS 询问 窗口 


| Summary 


Click Finish' to accept these MPLAB ICD 2 settings 


MPLAB ICD 2 Settings 
Com Port: COM4 
Baud Rate: 19200 


Power From: MPLAB ICD 2 
AutoConnect Enabled 
AutoDownlaad: Enabled 


it Sereda paces 
semal EA Sores: 








3-18 ”完成 窗口 
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| Build | Version Control | Find in Files | MPLAB ICD 2 


Connecting tn MPLAB ICD 2 

... Connected 

Setting Vdd source to MPLAB ICD 2 

Target Device PTC1BFBTT found, revision = Rey HG 
... Reading ICD Product ID 

Rurning ICD Self Test 

... Passed 

MPLAB ICT 2 Ready 





图 3-19 ”显示 连接 正常 的 输出 窗口 
3.3.10 更新 MPLAB ICD2 固件 (操作 系统 ) 


根据 MPLAB IDE 的 版 本 或 器 件 的 选择 ,会 提示 一 条 信息 说 明 固件 需要 更 新 。MPLAB 
IDE 将 自动 安装 新 的 固件 。 

同时 ， 由 于 不 同 的 MPLAB ICD2 固件 用 于 不 同 的 PIC 系列 单片机 ， 当 切换 不 同 的 PIC 系 
列 单片机 时 也 可 能 出 现 这 个 对 话 框 。 

固件 可 以 按照 下 面 的 步骤 手动 更 改 : 

选择 Debugger—Download ICD2 Operating System。 选 择 ICD2 固件 文件 对 话 框 会 打开 。 

从 裂变 中 或 浏览 器 中 选择 要 下 载 的 固件 文件 。 文 件 名 的 组 成 为 icdxxxxxx. hex， 其 中 
xxxxxx 为 版 本 号 。 关 于 MPLAB IDE 提供 最 新 版 本 的 信息 可 以 查看 README 文件 或 MPLAB 
ICD2. txt。 根 据 选择 的 PIC 器 件 版 本 可 能 会 变动 。 

单 击 “Open” 按 钮 ，MPLAB IDE 将 下 载 新 的 操作 系统 到 MPLAB ICD2 。 


3.3.11 生成 目标 文件 (编译) 


在 编译 之 前 ， 先 确认 编译 器 选择 正确 ， 选 择 Project—Select Language Toolsuite， 出 现 语 
言 选择 窗口 ， 如 图 3-20 所 示 。 如 果 程 序 用 汇编 语言 编写 ， 在 Active Toolsuite 中 应 选择 Micro- 
chip MPASM Toolsuite; 如 果 程 序 用 C 语言 编写 ， 在 Active Toolsuite 中 应 选择 HI-TECH PICC 
Toolsuite。 当 然 还 有 很 多 编译 器 可 供 选 择 ， 此 处 不 一 一 列举 。 

选择 Project—Build All 或 在 项 目 窗口 中 的 项 目 名 称 上 单 击 右键 ,并 从 弹出 菜单 中 选择 
“Build All” 。 

编译 器 总 会 生成 文件 名 与 源 文件 〈. e 文件 ) 名 相同 的 目标 文件 (.hex 文件 ) 。 编 译 时 
会 打开 一 个 状态 窗口 ， 显 示 编 译 的 进度 和 最 后 的 结果 。 编 译 完 成 后 ， 自 动 关闭 该 窗口 。 同 时 
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Select Language Toolsuite 


Active Toolsuite: 


Toolsuite Contents 


PICC Compiler (picc.exe] 


PICC Assembler [picc. exe] 
PICC Linker Iicc.ewel 





Location 


ICMHTPCNBINNPICEEXE | 


图 3-20 语言 选择 窗口 
还 将 打开 Output 窗口 ，Output 窗口 没有 出 现 红 色 和 警告 或 错误 信息 ,而 且 最 后 一 句 显示 
“BUILD SUCCEEDED”， 就 表示 编译 成 功 了 ， 如 图 3-21 所 示 。 




















M EPLAB IDE v6.62 - [Output] 





= Configure Window Help - ox 


| Checksum: 0x5258 PH 人 YP 人 TP |Y 


T] File Edit View Project Debugger Programmer 
| Dae |+mm|Sh? || FSR Ree 


| version Control | Find in Files | MPLAB ICD 2| 


























: Deleting intermediary and output files. 
Clean: Deleted file “c:\MyPrj\examl.cce”. 
Clean: Done. 

Executing: “C:\HT-PIC\BIN\PICC, EXE” -C -E"“examl.cce” “examl.c” -O"examl. obj” -Zg9 -0 -ASMLIST -Q -MPLAB -16F8T7A 
Executing: “C:\HT-PIC\BIN\PICC. EXE” -E"myprj. lde” “C:\MyPri\examl.obj" -M“myprj. map” -O"myprj. cof” -O"myprj.hex” -Q -MPLAB -16F877A 


Memory Usage Map: 
Program ROM $0000 - $005E $005F 【 95) words 


Program ROM $0114 - $07FF $06EC words 
$0746 【 1867) words total Program ROM 


= 
| 
2 


Bank 0 RAM $0020 - $004C $002D ( 45) bytes 
Bank 0 RAM $0070 - $0072 $0003 bytes 
$0030 ( 48) bytes total Bank 0 RAM 


2 


Bank 1 RAM $0040 - $00EF $0050 


œ 
= 


bytes total Bank 1 RAM 


Program statistics: 


Total ROM used 1867 words (22. 8%) 
Total RAM used 128 bytes (34. 8%) 


Loaded C:\MyPrj\mypri. cof 
BUILD SUCCEEDED: Fri Feb 09 20:38:31 2007 











MPLAB ICD 2 TFTC1BF8TTA pe: Ox2 wD Z DCe bank 0 
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注意 : 为 调试 生成 目标 文件 (. HEX 文件 ) 之 前 ， 必 须 已 经 选择 ICD 2 PEA Dai at o 

如 果 编 译 失 败 ， 请 检查 以 下 各 项 ， 然 后 重新 编译 项 目 : 

1) 检查 在 编辑 器 窗口 中 输入 的 所 有 代码 的 拼写 和 格式 。 如 果 在 Output 窗口 中 报告 有 错 
误 ， 双 击 该 错误 就 会 在 源 代 码 窗口 左 侧 的 灰色 区 域 中 以 绿色 箭头 指出 源 代 码 中 出 错 的 行 。 

2) 检查 用 于 该 项 目 及 其 项 目 文件 的 语言 工具 是 否 正确 。 

为 初学 者 解释 几 个 概念 : 

C 语言 是 一 种 高 级 编程 语言 ， 用 C 语言 进行 编程 写 出 的 代码 ,保存 为 .c 文件 ， 称 为 C 
语言 的 源 程 序 ， 但 单片机 无 法 识别 和 运行 源 程序 ， 单片机 只 能 看 懂 由 0 和 1 组 成 的 机 器 码 ， 
因此 这 里 需要 一 个 “翻译 ”的 过 程 ， 称 为 “编译 " ， 编 译 的 作用 就 是 把 单片机 无 法 识别 的 汇 
编 源 程序 翻译 成 单片机 能 识别 的 机 器 码 ， 如 图 3-22 所 示 ， 由 于 机 器 码 是 最 终 在 单片机 上 运 
行 的 代码 ， 因 此 也 称 为 目标 代码 ， 其 后 缀 是 hex, 




















图 3-22 ”编译 器 将 源 代码 转换 为 机 器 指令 








另外 ， 整 个 “翻译 ”的 过 程 是 由 一 个 PICC 工具 软件 完成 的 。 当 选择 Project 一 Build All 
时 ， 系 统 会 自动 调用 PICC 编译 絮 ， 自 动 完成 整个 编译 过 程 。 关 于 PICC 的 安装 与 使 用 请 参 
照 第 8 章 实验 一 。 


3.3.12 下 载 目标 代码 


在 调试 之 前 ， 必 须 把 目标 代码 下 载 到 目标 单片机 中 。 选 择 Debugger 一 Program， 把 目标 
文件 exam1.c (日 标 文 件 中 包括 的 就 是 目标 代码 ) 下 载 到 实验 板 上 的 PIC 中 。 下 载 可 能 需要 
几 分钟 时 间 。 在 下 载 过 程 中 ，Output 对 话 框 的 MPLAB ICD 2 选项 卡 下 会 显示 目前 的 操作 阶 
Be. Output 窗口 没有 出 现 红色 的 警告 或 错误 信息 ， 而 且 倒 数 第 3 句 显示 “…Programming 
succeeded”， 就 表示 下 载 成 功 了 ， 如 图 3-23 所 示 。 

注意 : 进入 调试 模式 的 一 个 必要 条 件 是 ， 开 发 板 或 应 用 系统 已 经 加 了 晶体 振荡 器 。 如 编 
程 右 模式 下 下 载 没 问 题 ， 但 调试 器 模式 下 下 载 不 成 功 ， 则 通常 是 开发 板 或 应 用 系统 忘 了 装 上 
晶体 振荡 器 。 注 意 : 初学 者 容易 将 Debugger (调试 器 ) 下 拉 菜 単 下 的 “Program (编程 )” 
命令 和 Programmer (编程 器 ) 下 拉 菜 单 下 的 “Program (编程 ) ”命令 混为一谈 ， 其 实 这 是 
两 个 作用 完全 不 同 的 命令 ， 切 记 : 在 调试 器 模式 下 ， 必 须 使 用 调试 器 下 拉 菜 单 下 的 “Pro- 
gram” 命 令 ， 同 样 ， 在 编程 器 模式 下 ， 必 须 使 用 编程 器 下 拉 菜 单 下 的 “Program ”命令 。 同 
时 也 不 要 以 为 : 在 编程 器 模式 下 已 经 执行 “Program” 命 令 了 ， 因 此 切换 到 调试 器 模式 时 ， 










































































ふ FLAB IDE v6.62 - [Output] 
| | File Edit View Project Debugger Programmer Toc Configure Window Help 
Checksum: Dx5527 








|Build | Version Control | Find in Files | MPLAB ICD 2 
Connecting to MPLAB ICD 2 
...Connected 
Setting Vdd source to MPLAB ICD 2 
Target Device PICI6F&TTA found, revision = Rev Oxé 
... Reading ICD Product ID 
Running ICD Self Test 
... Passed 
MPLAB ICD 2 Ready 
Resetting Target 
MPLAB ICD 2 Ready 
Programming Target... 
.. Erasing Part 
..Frogramming Program Memory (0x0 - OxTFF) 
. Loading DebugExecutive 
..Programming DebugExecutive 
...Programming Debug Vector 
Verifying... 
... Program Memory 
.. Debug Executive 
...Debug Vector 
... Verify Succeeded 
Programming Configuration Bits 
. Config Memory 
Verifying configuration memory... 
... Verify Succeeded 
Connecting to debug executive 
...Programming succeeded 
MPLAB ICD 2 Ready 




















PICIGFSTTA pe: Ox2 #:0 





图 3-23 下 载 目标 代码 窗口 


就 可 以 不 用 执行 调试 器 模式 下 的 “Program” 命 令 了 ， 这 是 大 错 特 错 的 ， 反 之 也 是 一 样 。 

Debugger (调试 器 ) 下 拉 菜 単 下 和 Programmer (afert) 下 拉 菜 单 下 还 有 许多 命令 在 字 
面 上 是 一 样 的 ,但 实际 功能 是 不 一 样 的 ， 注 意 不 要 混淆 。 下 面 将 作 进一步 的 解释 ， 初 学 者 可 
以 跳 过 不 读 。 

执行 Debugger (调试 器 ) PARAL PAY Program ( 编程) 命令 时 ， 系 统 会 自动 在 用 户 编 
写 程序 的 目标 代码 中 加 入 调试 执行 代码 ， 调 试 执行 代码 会 自动 下 载 到 程序 存储 器 的 高 端 地 
址 ， 以 便 用 “MPLAB ICD2 仿真 下 载 需 ”来 进行 调试 ， 这 种 状态 下 ，MPLAB IDE 可 以 通过 
MPLAB ICD2 仿真 下 载 右 来 监视 PIC 系列 单片机 的 各 个 存储 器 所 存储 的 内 容 ; 执行 Program- 
mer (编程 器 ) 下 拉 菜 单 下 的 Program 〈 编程 ) 命令 时 ， 系 统 只 将 用 户 编写 程序 的 目标 代码 
下 载 到 程序 存储 器 中 ，MPLAB IDE 无 法 监视 PIC 系列 单片机 存储 器 中 的 存储 内 容 。 由 此 可 
见 ， 这 两 个 编程 命令 的 作用 是 完全 不 同 的 。 
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3.3.13 ”运行 和 调试 


在 调试 器 模式 下 运行 examl 进入 调试 模式 后 ， 工 具 栏 会 多 出 调试 右 快 捷 工 具 条 ， 如 图 
3-24 所 示 。 





从 左 到 右 分 别 是 : 
b o H pP 

1) ran 一 全速 运 行 ; I o t PE 

2) halt 一 一 暂停 ; 








图 3-24 快捷 工具 条 








自动 单 步 (或 称 为 慢 速 运行 ); 
单 步 运 行 ( 子 程序 内 部 也 单 步 运 行 ); 
单 步 运 行 ( 子 程序 内 部 代码 被 全 速 执 行 ， 整 个 子 程序 被 作为 单 步 运 行 


3) animate 





4) step into 





5) step over 
中 的 一 步 来 执行 ) : 

6) step out 
FR) ; 

7) reset 复位 。 

MPLAB ICD 2 在 调试 器 模式 下 可 以 实时 或 单 步 执行 代码 ， 实 时 执行 代码 又 称 为 “全 速 
运行 ” ， 当 然 调 试 器 模式 下 的 “全 速 运 行 ” 与 单片机 脱离 开发 系统 独立 运行 时 的 “全 速 运 
行 ”还 是 有 区 别 的 ， 单 步 执行 代码 又 称 为 “ 单 步 运行 ”。 

首先 执行 调试 器 模式 下 的 “全 速 运 行 "。 选 择 Debugger 一 Run (或 单 击 Run 工具 栏 按 
钮 )。 

如 果 编 写 的 程序 没有 错误 ， 则 可 继续 下 一 步 一 一 在 编程 器 模式 下 下 载 目标 代码 ; 如 果 有 
错误 ， 则 先 选择 Debugger-*Halt (或 单 击 Halt 工具 栏 按钮 ) 来 中 止 程序 执行 ， 然 后 利用 一 些 
调试 方法 : 如 设置 断 点 对 程序 进行 修改 ， 直 到 无 误 为 止 。 需 要 注意 的 是 ， 当 对 程序 作 了 修改 
以 后 ， 记 得 保存 之 后 选择 Project—Build All 来 重新 编译 并 重新 下 载 源 代码 。 


3.3.14 ”在 编程 器 模式 下 下 载 目标 代码 


当 程 序 成 功 调试 并 运行 后 ， 下 一 步 是 在 编程 器 模式 下 下 载 PIC 系列 单片机 ， 以 便 它 能 脱 
离开 发 系统 而 独立 工作 。 进 行 这 一 步 时 ， 为 MPLAB ICD2 保留 的 资源 被 释放 。 

按照 以 下 步骤 进行 下 载 : 

1) 选择 Debugger 一 > Select Tool 一 








跳出 子 循环 当 程 序 运 行 在 子 程序 中 时 ， 可 以 使 用 它 直 接 运 行 完 该 子 程 




















a ret TS Programmer Tools Configure Window 
None, 禁止 MPLAB ICD 2 作为 调试 器 ， 一 ai E 
' 站 EEC 
如 图 3-25 所 示 。 | Clear Memory P| 1 MPLAB ICD 2 | 
2) 在 Programmer—Select Programmer 2 ELA ICE 4000 


菜单 中 ， 选 择 MPLAB ICD 2 作为 编程 器 ， Te 
如 图 3-26 所 示 。 

3) 选择 Programmer— MPLAB ICD2 
Setup Wizard…， 通 过 向 导 完 成 编程 器 的 
WH, 与 3.3.9 节 中 的 设置 方法 相似 。 

4) 选择 Programmer 一 Verify， 检 测 硬 件 连 接 。 如 果 检 测 无 误 ， 则 在 输出 窗口 出 现 提 示 ， 
如 图 3-27 所 示 。 

















图 325 禁止 MPLAB ICD 2 作为 调试 器 














Debugger ed Tools Configure 
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Window Help 





Select Programmer 


MFLAE ICD 2 Setup Wizard... 


Program 
Read 
Verify 
Erase Part 
Blank Check 


Release from Reset 
Hold in Reset 


Abort Operation 


Connect 


Hone 
1 FICSTART Flus 


3 MPLAB PM 3 l 


4 FRO MATE II 
5 FICkit 1 


Download ICDZ Operating System 


Settings... 





图 3-26 选择 MPLAB ICD2 作为 编程 器 


Version Control | Find in Files| MPLAB ICD 2 


Connecting to MPLAB ICD 2 
...Connected 

Setting Vdd source to MPLAB ICD 2 
Target Device PICIAFSTTA found, 
.. . Reading ICD Product ID 
Running ICD Self Test 

... Fassed 
MPLAB ICD 2 Ready 
Verifying... 

...Program Memory 

。 Config Memory 
Verifying configuration memory... 
... Verify Succeeded 
MPLAB ICD 2 Ready 





revision = Rev Oxé 


图 3-27 显示 硬件 连接 无 误 的 输出 窗口 


5) 选择 Programmer 一 >Program ， 下 载 程 序 到 目标 板 。 如 果 下 载 成 功 ， 则 在 输出 窗口 出 现 


提示 ， 如 图 3-28 所 示 。 
此 后 ,目标 板 可 以 独立 运行 了 。 
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Verify SB 
MPLAB ICD 2 Ready 
Programming Target... 
..Erasing Part 
..Programming Program Memory (0x0 - OxTFF) 
\Verifying... 


.» Program Memory 
.. Verify Succeeded 
Programming Configuration Bits 
. Config Memory 
Verifying configuration memory... 
.. Verify Succeeded 
.. Programming succeeded 
MPLAB ICD 2 Ready 








图 3-28 显示 下 载 成 功 的 输出 窗口 


3.3.15 文件 保存 


开发 工作 中 途 及 完成 后 ， 要 及 时 进行 文件 的 保存 ， 可 以 选择 File—Save Workspace, 保 
存 为 工作 空间 文件 或 选择 Project—Save Project, 保存 項目 文件 。 

下 面 对 这 两 种 文件 类 型 及 其 区 别 进行 说 明 : 

Project (項目 文件 ) 包括 了 编译 所 需 的 源 文 件 、 连 接 文件 、 头 文件 …… 及 这 些 文件 间 的 
组 织 结构 ， 同 时 还 包括 了 芯片 设置 、 配 置 位 设置 等 。 

Workspace (工作 空间 文件 ) 在 项 目 文件 包含 的 内 容 基 础 上 ， 还 进一步 包含 了 调试 器 或 
编程 器 的 选择 、 已 打开 的 窗口 等 。 

简单 地 说 : 项 目 文件 就 是 程序 员 辛 辛苦 苗 做 出 来 的 “产品 ”， 工 作 空间 文件 比 项 目 文件 
多 包括 了 一 些 内 容 ， 多 包括 的 内 容 其 实 就 是 做 “ 品 ” 过 程 中 用 到 的 各 种 工具 ， 例 如 当前 正 
在 调试 程序 ， 为 此 选择 了 “MPLAB ICD2 仿真 下 载 器 ” ， 还 打开 了 变量 观察 窗口 ， 这 些 在 
工作 空间 文件 中 也 会 被 保存 。 如 果 项 目 还 没有 最 终 完成 ， 那 么 在 保存 时 应 该 保存 为 工作 空间 
文件 类 型 ， 下 一 次 打开 时 ， 应 该 打开 这 个 项 目 文件 ， 这 样 出 现在 您 面前 的 一 切 和 您 上 次 看 到 
的 一 模 一 样 ， 您 可 以 方便 地 继续 您 未 完成 的 工作 。 


3.4 软件 编程 基础 


本 书 主要 采用 C 语言 进行 编程 ， 故 本 节 介 绍 一 些 C 语言 的 常用 语句 ， 其 他 语句 和 用 法 ， 
请 读者 根据 需要 参阅 其 他 相关 书籍 。 
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3.4.1 C 语言 概述 


C 语言 是 在 20 世纪 70 年 代 初 问世 的 。1978 年 由 美国 电话 电报 公司 (AT&T) 贝尔 实验 
室 正 式 发 表 了 CC 语言。 同时 由 B. W. Kernighan 和 D. M. Ritchit 合 著 了 著名 的 《THE C PRO- 
GRAMMING LANGUAGE》 一 书 。 通 党 简称 为 《K&R》， 也 有 人 称 之 为 《K&R》 标 准 。 但 是 ， 
在 《K&R》 中 并 没有 定义 一 个 完整 的 标准 C 语言 ， 后 来 由 美国 国家 标准 学 会 在 此 基础 上 制 
定 了 一 个 C 语言 标准 ， 于 1983 年 发 表 ， 通 常 称 之 为 ANSI C, 

C 语言 是 一 种 结构 化 语言 。 它 层次 清晰 ， 便 于 按 模块 化 方式 组 织 程序 ， 易 于 调试 和 维 
护 。C 语言 的 表现 能 力 和 处 理 能 力 极 强 。 它 不 仅 具 有 丰富 的 运算 符 和 数据 类 型 ， 便 于 实现 各 
类 复杂 的 数据 结构 。 它 还 可 以 直接 访问 内 存 的 物理 地 址 ， 进 行 位 (bit) 一 级 的 操作 。 由 于 
C 语言 实现 了 对 硬件 的 编程 操作 ， 因 此 C 语言 集 高 级 语言 和 低级 语言 的 功能 于 一 体 。 它 既 可 
用 于 系统 软件 的 开发 ， 也 适合 于 应 用 软件 的 开发 。 此 外 ，C 语言 还 具有 效率 高 、 可 移植 性 强 
等 特点 。 因 此 广泛 地 移植 到 了 各 类 各 型 计算 机 上 ， 从 而 形成 了 多 种 版 本 的 C 语言 。 这 些 C 
语言 版 本 不 仅 实 现 了 ANSI C 标准 ， 而 且 在 此 基础 上 各 自作 了 一 些 扩充 ， 使 之 更 加 方便 、 完 
美 。 


3.4.2 BS 

















整 型 量 包 括 整 型 常量 、 整 型 变量 。 整 型 常量 就 是 整 常数 。 在 C 语言 中 ,使 用 的 整 和 常数 
有 八进制 、 十 六 进 制 和 十 进 制 三 种 。 

1. KES 

(1) 八进制 整 常数 八进制 整 常 数 必 须 以 数 0 开头 ， 即 以 数 0 作为 八进制 数 的 前 级 。 数 
码 取 值 为 0 ~7。 八 进 制 数 通常 是 无 符号 数 的 。 

以 下 各 数 是 合法 的 八进制 数 : 

015 (十 进 制 为 13) 0101 (十 进 制 为 6 ) 0177777 (十 进 制 为 65535) 

以 下 各 数 不 是 合法 的 八进制 数 : 

256 (无 前 级 0) 03A2 (包含 了 非 八 进 制 数码 ) -0127 (出 现 了 负 号 ) 

(2) 十 六 进 制 整 常 数 ”十 六 进 制 整 常数 的 前 缀 为 0X 或 0x。 其 数码 取 值 为 0~9, A~F 
或 a~f。 

以 下 各 数 是 合法 的 十 六 进 制 整 常数 : 

0X2A (十 进 制 为 42) 0XAO (十 进 制 为 160) OXFFFF ( 十进制 为 65535 ) 

以 下 各 数 不 是 合法 的 十 六 进 制 整 常数 : 

SA (无 前 级 0X) ”0X3H (含有 非 十 六 进 制 数码 ) 

(3) 十 进 制 整 常数 十进制 整 常 数 没有 前 级 。 其 数码 为 0 ~9。 

以 下 各 数 是 合法 的 十 进 制 整 常数 : 

237 -568 65535 1627 

以 下 各 数 不 是 合法 的 十 进 制 整 常数 : 

023 (不 能 有 前 导 0) 23D (含有 非 十 进 制 数码 ) 

2. 整 型 变量 

整 型 变量 可 分 为 以 下 几 类 : 中 基本 型 ， 类 型 说 明 符 为 int， 在 内 存 中 占 2 字 节 ， 其 取 值 
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为 基本 整 常数 。 加 得 整 型 ， 类 型 说 明 符 为 short int 或 short'C110F1。 所 占 字 节 和 取 值 范围 均 
与 基本 型 相同 。@) 长 整 型 ， 类 型 说 明 符 为 long int 或 long， 在 内 存 中 占 4 字 节 ， 其 取 值 为 长 
整 常数 。@ 无 符号 型 ， 类 型 说 明 符 为 unsigned, 

无 符号 型 又 可 与 上 述 三 种 类 型 匹配 而 构成 :OD 无 符号 基本 型 ， 类 型 说 明 符 为 unsigned int 
或 unsigned。 回 无 符号 短 整 型 ， 类 型 说 明 符 为 unsigned short。@ 无 符号 长 整 型 ， 类 型 说 明 符 
为 unsigned long。 各 种 无 符号 类 型 量 所 占 的 内 存 空间 字 节 数 与 相应 的 有 符号 类 型 量 相同 。 但 
由 于 省 去 了 符号 位 ， 故 不 能 表示 负数 。 

整 型 变量 的 说 明 : 变量 说 明 的 一 般 形 式 为 : 类 型 说 明 符 变量 名 标识 符 ， 变 量 名 标识 符 ， 





例如 : 

inta, b, c; (a, b,c 为 整 型 变量 

long x, y; (x, y 为 长 整 型 变量 ) 
unsigned p, q; (p, q 为 无 符号 整 型 变量 ) 


=p] 


3.4.3 符号 常量 


在 C 语言 中 ， 可 以 用 一 个 标识 符 来 表示 一 个 常量 ， 称 之 为 符号 常量 。 符 号 常量 在 使 用 
之 前 必须 先 定义 ， 其 一 般 形 式 为 : 

#define 标识 符 常量 

其 中 ，#define 也 是 一 条 预 处 理 命 令 ， 称 为 宏 定义 命令 ， 其 功能 是 把 该 标识 符 定义 为 其 
后 的 常量 值 。 一 经 定义 ， 以 后 在 程序 中 所 有 出 现 该 标识 符 的 地 方 均 代 之 以 该 常量 值 。 习 惯 上 
符号 常量 的 标识 符 用 大 写字 母 ， 变 量 标识 符 用 小 写字 母 ， 以 示 区 别 。 

#define PI 3. 14159 


void main () 


























| floats, r; 
r=5.0; 
s=PI*r*r; 
printf ("s=%f\ n”, s); 
| 
程序 运行 结果 如 下 : 
s =78. 539749 
程序 中 用 #define 命令 行 定 义 PI 代表 一 串 字符 3. 14159 ， 在 对 程序 进行 编译 时 ， 凡 本 程 
序 中 出 现 PL 的 地 方 ， 编 译 程序 均 用 3. 14159 这 一 字符 串 来 代 蔡 ， 在 这 里 ，PI 是 一 个 用 户 自 
己 选 择 的 符号 名 ， 本 程序 中 ， 可 以 把 PI 视 为 3. 14159 的 替身 。 


3.4.4 简单 赋值 运算 与 赋值 表达 式 

在 C 语言 中 ,“=” 符 号 称 为 赋值 运算 符 ， 由 赋值 运算 符 组 成 的 表达 式 称 为 赋值 表达 
式 ， 其 一 般 形 式 为 : 

变量 名 = 表达 式 

例如 : 


a= 10 /* 把 常量 10 赋 给 变量 ax/ 
b =a /* 把 a 中 的 值 赋 给 变量 b，a 中 的 值 不 变 */ 

赋值 表达 式 的 功能 是 把 计算 表达 式 的 值 再 赋予 左边 的 变量 。 赋 值 运算 符 具 有 右 结 合 性 。 
因此 a=b=c=5 可 理解 为 a= (b= (c=5))。 

在 其 他 高 级 语言 中 ， 赋 值 构 成 了 一 个 语句 ， 称 为 赋值 语句 。 而 在 C 语言 中 , 把 “=” 
定义 为 运算 符 ， 从 而 组 成 赋值 表达 式 。 几 是 表达 式 可 以 出 现 的 地 方 均 可 出 现 赋值 表达 式 。 例 
W, 式 子 x= (a=5) + (b=8) 是 合法 的 。 它 的 意义 是 把 5 赋予 a，8 WF b, HHE a, b 
相 加 ， 和 赋予 x， 故 x 应 等 于 13。 

在 C 语言 中 也 可 以 组 成 赋值 语句 ， 按 照 C 语言 规定 ， 任 何 表达 式 在 其 末尾 加 上 分 号 就 
构成 为 语句 。 因 此 如 : 

x=8; 

a=b=c=5; 

都 是 赋值 语句 ， 如 果 赋 值 运算 符 两 边 的 数据 类 型 不 相同 ， 系 统 将 自动 进行 类 型 转换 ， 即 
把 赋值 号 右边 的 类 型 换 成 左边 的 类 型 。 


3.4.5 控制 语句 


1. if 4) 

用 站 语句 可 以 构成 分 支 结 构 。 它 根据 给 定 的 条 件 进行 判断 ， 以 决定 执行 某 个 分 支 程 序 
段 。C 语言 的 站 语句 有 三 种 基本 形式 。 

1) 第 一 种 形式 为 基本 形式 if (RAA) 语句 ; 其 语义 是 : 如 果 表 达 式 的 值 为 真 ， 则 执 
行 其 后 的 语句 ， 否 则 不 执行 该 语句 。 

例如 : 


void main( ) 
































| int a,b,max; 
printf(" \n input two numbers; " ) ; 
scanf(" %d% d" ,&a,&b) ; 
max =a; 
if (max <b) max =b; 
printf(" max = % d" ,max) ; 
| 
本 例 程序 中 ， 输 入 两 个 数 a，b。 把 a 先 赋予 变量 max, 再 用 六 语句 判别 max 和 b 的 大 
如 max 小 于 b， 则 把 b 赋予 max。 因 此 max 中 总 是 大 数 ， 最 后 输出 max 的 值 。 
2) 第 二 种 形式 为 让 else 形式 。 
if (表达 式 ) 
语句 1; 
else 
语句 2; 
其 语义 是 : 如 果 表 达 式 的 值 为 真 ， 则 执行 语句 1， 否则 执行 语句 2。 
例如 : 同样 完成 功能 : 输入 两 个 整数 ， 输 出 其 中 较 大 的 数 ， 改 用 if-else 语句 判别 a、b 





小 


-> 
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的 大 小 , 春 a 大 ， 则 输出 a， 否则 输出 bo 
void main () 
| int a, b; 
printf (" input two numbers; " ) ; 
scanf ("%d%d", &a, &b); 
if (a>b) 
printf (" max=%d\n", a); 
else 
printf (" max=%d\n", b); 
| 
3) 第 三 种 形式 为 if-else-if 形式 。 
前 两 种 形式 的 站 语句 一 般 都 用 于 两 个 分 支 的 情况 ， 当 有 多 个 分 文选 择 时 ， 可 采用 if-else- 
让 语 句 ， 其 一 般 形 式 为 : 
if (表达 式 1) 
语句 1; 
else if (表达 式 2) 
语句 2; 
else if (表达 式 3) 
语句 3; 


else if (表达 式 m) 

语句 m; 

else 

语句 n; 

其 语义 是 : 依次 判断 表达 式 的 值 ， 当 出 现 某 个 值 为 真 时 ， 则 执行 其 对 应 的 语句 ， 然 后 跳 
到 整个 站 语句 之 外 继续 执行 程序 。 如 果 所 有 的 表达 式 均 为 假 ， 则 执行 语句 n， 然 后 继续 执行 
后 续 程 序 。 

例如 : 判别 键盘 输入 字符 的 类 别 。 可 以 根据 输入 字符 的 ASCTI 来 判别 类 型 。 由 ASCI 表 
可 知 , ASCH 值 小 于 32 的 为 控制 字符 。 在 “0” 和 “9” 之 间 的 为 数字 , E “A” AZ” Zz 
间 的 为 大 写字 和 母 , 在 “a” 和 “z” 之 间 的 为 小 写字 母 ， 其 余 则 为 其 他 字符 。 这 是 一 个 多 分 文 
选择 的 问题 ， 用 if-else-if 语句 编程 ， 判 断 输 入 字符 ASCI 所 在 的 范围 ， 分 别 给 出 不 同 的 输 
出 。 例 如 输入 为 “g”， 输 出 显示 它 为 小 写字 符 。 

#include" stdio. h" 


void main( ) 























| char c; 
printf( "input a character: " ) ; 
c = getchar() ; 
if(c <32) 


printf( " This is a control character\n" ) ; 
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else if(c >='0'&&c <='9') 
printf( "This is a digit\n" ) ; 
else if(c >='A'&&e <='Z') 
printf("This is a capital letter\n" ) ; 
else if(c >='al &&c <='z') 
printf("This is a small letter\n" ) ; 
else 
printf( " This is an other character\n" ) ; 
| 
使 用 证 语句 时 需 注意 以 下 几 个 问题 : 
1) 在 三 种 形式 的 圭 语 句 中 ， 在 过关 键 字 之 后 均 为 表达 式 。 该 表达 式 通 和 常 是 逻辑 表达 式 
或 关系 表达 式 , 但 也 可 以 是 其 他 表达 式 ， 如 赋值 表达 式 等 ， 其 至 也 可 以 是 一 个 变量 。 例 如 : 
if (a=5) 语句 ; if (b) 语句 ; 都 是 允许 的 。 只 要 表达 式 的 值 为 非 0， 即 为 “ 真 "” WEI (a 
=S) …; 中 ， 表 达 式 的 值 永远 为 非 0， 所 以 其 后 的 语句 总 是 要 执行 的 ， 当 然 这 种 情况 在 程 
序 中 不 一 定 会 出 现 ， 但 在 语法 上 是 合法 的 。 
2) 在 站 语句 中 ， 条 件 判 断 表 达 式 必须 用 括号 括 起 来 , 在 语句 之 后 必须 加 分 号 。 
3) 在 站 语句 的 三 种 形式 中 ， 所 有 的 语句 应 为 单个 语句 ， 如 果 要 想 在 满足 条 件 时 执行 一 
组 (多 个 ) 语句 ， 则 必须 把 这 一 组 语句 用 {| 括 起 来 组 成 一 个 复合 语句 。 但 要 注意 的 是 在 ! 
之 后 不 能 再 加 分 号 。 例 如 : 
if (a>b) 


att ; 








b++; 








4) 让 和 else 子 句 中 可 以 是 任意 合法 的 C 语句 ， 因 此 当然 也 可 以 是 站 语句 ， 通 常 称 此 为 
柑 套 的 站 语 句 。 内 椒 的 过 语句 既 可 以 般 套 在 这 子 句 中 ， 也 可 以 要 套 在 else 子 句 中 。 例 如 : 根 
据 输 入 的 学 生成 绩 ， 给 出 相应 的 等 级 。90 分 以 上 的 等 级 为 A, 60 分 以 下 的 等 级 为 E， 其 余 
每 10 分 为 一 个 等 级 。 


main( ) 








| int g; 
printf(" Enter g: "); 
scanf("%d" ,&g) ; 
printf("g =%d:",g) ; 
if(g >=90 ) 
printf("A" \n) ; 
else if( g >=80) 
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printf("B" \n) ; 
else if( g >=70) 
printf("C" \n) ; 
else if( g >=60) 
printf("D" \n) ; 
else 
printf("E" \n) ; 
2. switch 语句 
C 语言 还 提供 了 另 一 种 用 于 多 分 文选 择 的 switch 语句 ， 其 一 般 形式 为 : 
switch (表达 式 ) | 
case 常量 表达 式 1: 语句 1; 
case 常量 表达 式 2: 语句 2; 


Case 常量 达 式 n: 语句 n; 

default; iJ n +1; 

| 

其 语义 是 : 计算 表达 式 的 值 。 并 逐个 与 其 后 的 常量 表达 式 值 相 比 较 ， 当 表达 式 的 值 与 某 
个 常量 表达 式 的 值 相等 时 ， 即 执行 其 后 的 语句 ， 然 后 不 再 进行 判断 ， 继 续 执行 后 面 所 有 case 
后 的 语句 。 如 表达 式 的 值 与 所 有 case 后 的 常量 表达 式 均 不 相同 时 ， 则 执行 default 后 的 语句 。 
例如 : 


void main( ) 








| int a; 
printf ( " input integer number; " ) ; 
scanf("%d" ,&a) ; 
switch (a) 
| case 1 :printf(" Monday \n" ) ; 
case 2; printf(" Tuesday \n" ) ; 
case 3 :printf(" Wednesday \n" ) ; 
case 4; printf(" Thursday \n" ) ; 
case 5; printf(" Friday \n" ) ; 
case 6; printf(" Saturday \n" ) ; 
case 7 :printf(" Sunday \n" ) ; 
default : printf ( " error \n" ) ; 
| 
| 
本 程序 是 要 求 输入 一 个 数字 ， 输 出 一 个 英文 单词 。 但 是 当 输 入 3 之 后 ， 却 执行 了 case3 
以 及 以 后 的 所 有 语句 ， 输 出 了 Wednesday 及 以 后 的 所 有 单词 。 这 当然 是 不 希望 的 。 为 什么 会 
出 现 这 种 情况 呢 ? 这 恰恰 反映 了 switch 语句 的 一 个 特点 。 在 switch 语句 中 , “case 常量 表达 
式 ” 只 相当 于 一 个 语句 标号 , 表达 式 的 值 和 某 标号 相等 则 转向 该 标号 执行 ， 但 不 能 在 执行 完 
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该 标号 的 语句 后 自动 跳出 整个 switch 语句 ， 所 以 出 现 了 继续 执行 所 有 后 面 case 语句 的 情况 。 
这 是 与 前 面 介绍 的 站 语句 完全 不 同 的 ， 应 特别 注意 。 为 了 避免 上 述 情 况 , C 语言 还 提供 了 一 
种 break 语句 ， 专 用 于 跳出 switch 语句 ，break 语句 只 有 关键 字 break, 没有 参数 。 在 后 面 还 
将 详细 介绍 。 修 改 例题 的 程序 ， 在 每 一 个 case 语句 之 后 增加 break 语句 , 使 每 一 次 执行 之 后 
均 可 跳出 switch 语句 ， 从 而 避免 输出 不 应 有 的 结 


void main( ) 





| int a; 
printf( "input integer number; " ) ; 
scanf(" %d" ,&a) ; 
switch (a) 

| case 1:printf(" Monday \n" ) ; break ; 
case 2; printf('" Tuesday \n" ) ; break; 
case 3 :printf(" Wednesday \n" ) ; break ; 
case 4; printf(" Thursday \n" ) ; break ; 
case 5; printf(" Friday \n" ) ; break; 
case 6; printf(" Saturday \n" ) ; break ; 
case 7 : printf(" Sunday \n" ) ; break ; 
default :printf( "error\n" ) ; 


| 

| 

在 使 用 switch 语句 时 还 应 注意 以 下 几 点 : 

1) 在 case 后 的 各 和 常量 表达 式 的 值 不 能 相同 ， 否 则 会 出 现 错误 。 

2) Æ case 后 ， 人 允许 有 多 个 语句 ， 可 以 不 用 1} 括 起 来 。 

3) 各 case 和 default 子 句 的 先后 顺序 可 以 变动 ， 而 不 会 影响 程序 执行 结 

4) default 子 句 可 以 省 略 不 用 。 

3. while 语句 

while 语句 的 一 般 形式 为 : 

while (表达 式 ) 语句 ; 

其 中 ， 表 达 式 是 循环 条 件 ， 语 句 为 循环 体 。while 语句 的 语义 是 : 计算 表达 式 的 值 ， 当 
值 为 真 ( 非 0) 时 ， 执 行 循环 体 语句 。 

例如 : 统计 从 键盘 输入 一 行 字符 的 个 数 。 


#include <stdio.h > 





void main( ) 

| int n =0: 
printf( "input a string: \n" ) ; 
while( getchar( )! ='\n) n++; 
printf("%d" ,n) ; 

| 

本 例 程 序 中 的 循环 条 件 为 getchar ()! ='\ n, RHENE: 只 要 从 键盘 输入 的 字符 不 是 
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回 车 就 继续 循环 。 循 环 体 n++ 完成 对 输入 字符 个 数 计数 。 从 而 程序 实现 了 对 输入 一 行 字 符 
的 字符 个 数 计数 。 

使 用 while 语句 应 注意 以 下 几 点 : 

1) while 语句 中 的 表达 式 一 般 是 关系 表达 或 逻辑 表达 式 ， 只 要 表达 式 的 值 为 真 〈 非 0) 
即 可 继续 循环 。 

2) 循环 体 如 包括 有 一 个 以 上 的 语句 ， 则 必须 用 | | 括 起 来 , 组 成 复合 语句 。 

3) 应 注意 循环 条 件 的 选择 ， 以 避免 死 循 环 。 

4. do-while 语句 

do-while 语句 的 一 般 形 式 为 : 

do 

语句 ; 

while (表达 式 ); 

其 中 ,语句 是 循环 体 ， 表 达 式 是 循环 条 件 。 

do-while 语句 的 语义 是 : 先 执行 循环 体 语句 一 次 , 再 判别 表达 式 的 值 ， 看 为 真 EO) 
则 继续 循环 ， 否 则 终止 循环 。do-while 语句 和 while 语句 的 区 别 在 于 do-while 是 先 执行 后 判 
Wr, 因 此 do-while 至 少 要 执行 一 次 循环 体 。 而 while 是 先 判断 后 执行 ， 如 果 条 件 不 满足 ， 则 
一 次 循环 体 语句 也 不 执行 。while 语句 和 do-while 语句 一 般 都 可 以 相互 改写 。 

对 于 do-while 语句 还 应 注意 以 下 几 点 : 

1) 在 过 语句 和 while 语句 中 , 表达 式 后 面 都 不 能 加 分 号 , 而 在 do-while 语句 的 表达 式 后 
面 则 必须 加 分 号 。 

2) do-while 语句 也 可 以 组 成 多 重 循环 ， 而 且 也 可 以 和 while 语句 相互 般 套 。 

3) 在 do 和 while 之 间 的 循环 体 由 多 个 语句 组 成 时 ， 也 必须 用 1} 括 起 来 组 成 一 个 复合 
语句 。 

4) do-while 和 while 语句 相互 蔡 换 时 ， 要 注意 修改 循环 控制 条 件 。 

5. for 语句 

for 语句 是 C 语言 所 提供 的 功能 更 强 、 使 用 更 广泛 的 一 种 循环 语句 。 其 一 般 形 式 为 : 

for (表达 式 1; 表达 式 2; 表达 式 3) 

语句 ; 

其 中 ， 表 达 式 1 通常 用 来 给 循环 变量 赋 初 值 ， 一 般 是 赋值 表达 式 。 也 人 允许 在 for 语句 外 
给 循环 变量 赋 初 值 ， 此 时 可 以 省 略 该 表达 式 。 表 达 式 2 通常 是 循环 条 件 ， 一 般 为 关系 表达 式 
或 逻辑 表达 式 。 表 达 式 3 通常 可 用 来 修改 循环 变量 的 值 ， 一 般 是 赋值 语句 。 这 三 个 表达 式 都 
可 以 是 逗号 表达 式 ,， 即 每 个 表达 式 都 可 由 多 个 表达 式 组 成 。 三 个 表达 式 都 是 任 选 项 ， 都 可 以 
省略 。 

一 般 形式 中 的 “语句 ” 即 为 循环 体 语句 。for 语句 的 语义 是 : 

1) 首先 计算 表达 式 1 的 值 。 

2) 再 计算 表达 式 2 WA, AENA CEO), UTA IK, 否则 跳出 循环 。 

3) 然后 再 计算 表达 式 3 的 值 ， 转 回 第 2 步 重复 执行 。 在 整个 for 循环 过 程 中 ， 表 达 式 1 
只 计算 一 次 ， 表 达 式 2 和 表达 式 3 则 可 能 计算 多 次 。 循 环 体 可 能 多 次 执行 ， 也 可 能 一 次 都 不 
执行 。 
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例如 : 计算 s=1+2+3+... +99+100 
void main () 
| intn, s=0; 
for (n=1; n<=100; n++) 
s=s+n; 
printf (" s=%d\n", s); 
| 
另外 ，for 语句 也 可 与 while 语句 、do-while HAERE, WREE. 
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机 需 人 竞赛 是 近年 来 国际 上 迅速 开展 起 来 的 一 种 高 科技 对 抗 活动 ， 它 涉及 人 工 智 能 、 自 
动 控 制 、 机 械 电 子 、 通 信 、 传 感 及 机 构 等 多 个 领域 的 前 沿 研究 和 技术 融合 。 本 章 所 述 的 竞赛 
机 老人 平台 是 为 青少年 参加 各 种 机 器 人 大 赛 而 搭建 的 一 个 硬件 平台 ， 在 这 个 硬件 平台 基础 
上 ， 可 以 方便 地 实现 迷 宣 机 器 人 、 寻 线 机 器 人 、 滑 雪 机 器 人 、 灭 火 机 器 人 等 的 创建 。 同 时 在 
这 个 平台 可 以 开展 各 种 单片机 编程 练习 ， 完 成 单片机 的 各 种 功能 。 也 可 以 练习 各 种 算法 的 实 
现 ， 如 深度 优先 搜索 法 、 广 度 优先 搜索 法 、A 搜索 法 等 。 下 面 就 来 介绍 一 下 机 器 人 和 平台 的 


整体 设计 。 
4.1 平台 的 机 械 结 构 


竞 赛 机 器 人 平台 的 机 械 结构 为 层次 结构 ， 如 图 4-1 所 示 。 层 与 层 之 间 用 标准 铜 柱 支撑 ， 
电气 连接 采用 标准 搬 针 捕 座 连接 ， 便 于 拆 装 和 维护 。 其 电路 板 分 为 两 层 : 下 层 是 驱动 板 ; 上 
层 是 控制 板 。 

苑 赛 机 器 人 驱动 板结 构 如 图 4-2 所 示 。 它 主要 包括 左右 车 轮 、 两 个 改造 后 的 舵 机 、 四 个 
色差 传感器 、 万 向 轮 、 电 气 连 接 插座 、H 桥 驱 动 蕊 片 等 。 迷 宫 机 器 人 转弯 的 中 心 与 驱动 板 的 
中 心 一 致 ， 这 样 小 车 转弯 半径 最 小 ， 行 动 灵活 。 

竞赛 机 器 人 控制 板结 构 如 图 4-3 所 示 。 

ee Lait AE Hl BREE LG CPU 单元 、 传 感 需 调理 电路 、 传 感 器 驱动 电路 、 遥 控 需 无 
线 接收 单元 、RS232 通信 电路 、 串 行 口 编程 座 等 。 传 感 铝 外形 如 图 4-4 所 示 。 









































图 4-1 竞赛 机 器 人 平台 的 整体 外 观 





63 
























































= 
w 
Hh 
N 
= 





改造 后 











图 





结构 


动 板 


2 IK 


图 4 



























































fell rir 
EILIS LILeLILI 


I ロ II 
[Ss] 


PIC16F877 CPU 





无 线 接收 











= 























构 


H 





赛 机 器 人 控制 板结 


ar 
56 


图 433 




















UTGND | 


RERE 


(0) 


H 
ND | 
Vcc 


光 




















G 


GND Vcc OUT 


Vcc OUT GND Vcc 


OUT 


RPM-638 


红外 传感器 外 


SFH506-38 


形 


图 4-4 





64 


4.2 平台 的 行走 机 构 


行走 机 构 ， 也 称 为 机 器 人 的 下 胶 ， 是 机 器 人 的 关键 部 分 ， 主 要 用 来 承受 体重 和 完成 位 
它 决 定 着 机 器 人 能 和 否 迅速 灵 活 地 移动 ， 能 和 否 准 确 地 按照 操作 者 的 意愿 到 达 指 定点 。 

机 器 人 的 行走 机 构 首 先 要 体现 稳定 性 ， 其 次 是 灵活 性 。 很 多 工业 机 器 人 都 不 具备 行走 机 
构 ， 它 们 在 固定 的 位 置 完成 固定 的 动作 ， 因 此 只 需要 一 个 机 械 臂 ， 也 就 是 我 们 说 的 执行 机 
构 。 但 是 当 生 产 过 程 需要 一 个 机 器 人 在 较 大 的 范围 内 工作 时 ， 如 果 不 具备 行走 机 构 ， 那 么 它 
的 体积 将 非常 庞大 ; 如 果 安 置 了 行走 机 构 ， 可 以 使 它 做 适当 的 位 移 ， 在 工作 范围 的 不 同 区 间 
工作 ， 可 以 节约 空间 、 提 高 效率 。 对 于 竞赛 机 器 人 平台 来 说 ， 行 走 机 构 是 必 不 可 少 的 。 

机 器 人 的 行走 方式 主要 有 三 种 : 足 式 行走 、 履 带 式 行 走 和 轮 式 行走 。 轮 式 行走 机 构 由 滚 
动 摩擦 代替 滑动 摩擦 ， 主 要 的 特点 是 效率 高 ， 适 合 在 平坦 的 路 面 上 移动 ， 定 位 准确 ， 而 且 重 
量 较 轻 ， 制 作 简 单 。 在 各 类 机 器 人 竞赛 中 ， 场 地 通常 比较 固定 ， 路 面 状况 好 ， 而 且 又 对 参赛 
机 咒 人 重量 上 有 限制 ， 所 以 轮 式 机 器 人 可 以 发 挥 出 它 高 效率 的 特点 ， 在 机 器 人 竞赛 中 使 用 得 
最 多 。 下 面 就 轮 式 行走 方式 进行 讨论 。 在 机 器 人 的 设计 中 一 般 常 用 的 轮 式 结构 布置 有 以 下 几 
种 : 

1. 三 轮 式 车 体 

三 轮 式 车 体 的 两 个 驱动 轮 安装 在 前 边 的 两 侧 ， 只 在 后 端 装 有 
一 个 从 动 轮 ， 位 于 两 驱动 轮 的 中 垂 线 上 ， 构 成 三 点 布置 型 式 ， 如 
图 4-5 所 示 。 使 用 三 个 轮 的 优点 是 所 有 的 车 轮 都 会 着 地 ， 不 会 产 
生 悬 空 现 象 ， 控 制 稳定 。 但 当 机 器 人 重心 偏 移 时 ， 如 转变、 相 撞 
等 ， 由 于 只 有 三 个 轮子 文 撑 车 体 ， 稳 定性 不 好 。 

2. 四 轮 式 车 体 图 4-5 三 轮 式 

四 轮 式 车 体 四 个 轮子 位 于 车 体 的 四 个 角 ， 前 边 是 驱动 轮 ， 后 
边 是 从 动 轮 ， 如 图 4-6 所 示 。 较 三 轮 车 体 来 说 ， 四 个 轮子 可 以 更 好 地 支撑 车 体 ， 行 走 稳定 ， 
当 重 心 偏 移 时 ， 左 右 晃动 小 。 但 如 果 某 个 车 轮 的 中 心 不 正 ,或 是 安装 高 度 有 误差 ， 可 能 导致 
四 个 车 轮 不 能 同时 着 地 ， 使 控制 困难 。 所 以 在 安装 车 轮 时 ， 一 定 要 保证 驱动 轮 绝对 着 地 。 

3， 对 称 四 轮 式 车 体 

对 称 四 轮 式 如 图 4-6 所 示 ， 与 一 般 四 轮 式 车 体 相 比 ， 两 个 驱动 轮 前 移 ， 安 装 在 前 后 两 侧 
的 中 线 上 ， 两 个 从 动 轮 前 后 各 一 个 ， 四 个 轮子 安装 呈 “ 十 ”字形 ， 如 图 4-7 所 示 。 由 于 四 个 
轮 不 是 安装 在 车 体 的 四 个 角 ， 支撑 的 稳定 性 不 如 图 4-6 所 示 的 四 轮 式 车 体 。 但 是 ， 车 体 是 前 
后 对 称 的 ， 某 些 机 器 人 只 要 求 底盘 是 前 后 对 称 的 (如 要 求 原 地 转弯 )， 可 采用 此 驱动 方式 。 
由 于 小 车 是 靠 驱动 轮 与 地 面 产生 附着 力 改变 运动 状态 ， 因 此 不 论 何 种 布置 形式 ， 在 小 车 的 运 
动 过 程 中 的 某 一 瞬时 状态 只 能 是 三 点 支撑 。 即 要 么 前 一 个 被 动 支 撑 轮 与 两 个 驱动 轮 同时 着 
地 ， 要 么 后 一 个 被 动 文 撑 轮 与 两 个 驱动 轮 同时 着 地 。 昌 然 ， 由 于 驱动 轮 上 轮胎 的 弹性 会 使 得 
在 小 车 的 运动 过 程 中 的 某 一 瞬时 呈现 四 轮 着 地 的 现象 ， 但 这 种 情况 应 尽量 避免 出 现 ， 多 一 个 
被 动 支撑 轮 着 地 只 会 增加 小 车 与 地 面 的 摩擦 力 ， 从 而 消耗 更 多 的 能 量 (由 于 小 车 尺寸 受到 
严格 限制 ， 车 载 能 量 是 有 限 的 ) 。 在 小 车 的 运动 过 程 中 ， 绝 对 不 允许 出 现 两 个 驱动 轮 离开 地 
面 的 现象 。 竞 赛 机 器 人 和 平台 是 集 多 种 功能 于 一 身 的 ， 要 求 机 器 人 平台 可 以 原 地 左 转 或 者 原 地 
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右 转 ， 为 了 保证 机 器 人 在 转弯 过 程 中 的 灵活 性 ， 这 里 选择 了 对 称 四 轮 式 车 体 结构 。 


图 4-6 四 轮 式 图 4-7 对 称 四 轮 式 


4.3 能 机 











舵 机 最 早出 现在 航模 运动 中 。 在 航空 模型 中 ， 飞 行 器 的 飞行 姿态 是 通过 调节 发 动机 和 各 
个 控制 舵 面 来 实现 的 ， 舵 机 因此 得 名 。 控 制 舵 面 的 伺服 电动 机 ， 不 仪 在 航模 飞机 中 ， 在 其 他 
的 模型 运动 中 都 可 以 看 到 它 的 应 用 。 船 模 上 用 来 控制 尾 舵 ， 车 模 中 用 来 转向 等 。 由 此 可 见 ， 
凡是 需要 操作 性 动作 时 都 可 以 用 艇 机 来 实现 。 

1. 舵 机 的 结构 

一 般 来 讲 ， 舵 机 主要 由 舵 盘 、 减 速 齿轮 组 、 位 置 反 馈 电 位 器 (5k)、 直 流 电 动机 、 控 制 
电路 板 等 组 成 ， 如 图 4-8 所 示 。 实 际 的 舵 机 又 有 许多 区 别 ， 例 如 直流 电动 机 就 有 有 刷 和 无 刷 
之 分 ， 齿 轮 有 塑料 和 金属 之 分 ， 输 出 轴 有 滑动 和 滚动 之 分 ， 速 度 有 快速 和 慢 速 之 分 等 ， 组 合 
不 同 ， 价 格 也 千差万别 。 例 如 ， 其 中 小 舵 机 一 般 称 作 微 舵 ， 同 种 材料 的 条 件 下 价格 是 中 型 的 
一 倍 和 多 ,金属 齿轮 价格 是 塑料 齿轮 的 一 倍 和 多。 需要 根据 需要 选用 不 同类 型 。 常 见 的 舵 机 厂家 
A: 日 本 的 Futaba, JR, SANWA 等 公司 ,国产 的 有 北京 的 新 幻想 、 吉 林 的 振 华 等 公司 。 

舵 机 的 瞬时 运动 速度 是 由 其 内 部 的 直流 电动 机 和 变速 齿轮 组 
的 配合 来 决定 的 ， 在 恒定 的 电压 驱动 下 ， 其 数值 是 恒定 的 。 但 其 
平均 运动 速度 可 通过 分 段 停 顿 的 控制 方式 来 改变 ， 例如， 把 动作 


























间 长 短 来 实现 0° ~90° 变 化 的 平均 速度 。 对 于 多 数 舵 机 来 说 ,速度 1 2 
的 单位 是 “ 度 / 秒 "。 SA 
慰 准 的 能 机 有 三 条 引线 ， 分 别 为 : 电源 线 VCC、 地 线 GND 及 アデ 
控制 线 CON， 如 图 4-9 所 示 。 电 源 线 与 地 线 用 于 提供 内 部 的 直流 
电动 机 及 控制 线路 所 需 的 能 源 ， 电 压 通常 介 于 4 ~ OV 之 间 ,该 电 TEASER 
源 应 尽 可 能 地 与 CPU 系统 的 电源 隔离 〈 因 为 舵 机 会 产生 噪声 ) 。 ea s EuR 
甚至 小 能 机 在 重负 载 时 也 会 拉 低 放大 器 的 电压 ， 所 以 整个 系统 的 4 控制 电路 板 
电源 供应 的 比例 必须 合理 。 
2. 舵 机 的 工作 原理 
舵 机 是 一 个 典型 闭环 反馈 系统 ， 其 工作 原理 如 图 4-10 所 示 。 
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图 4-10 ”能 机 工作 原理 框图 





减速 齿轮 组 由 电动 机 驱动 ， 其 齿轮 组 的 输出 轴 带 动 一 个 线性 的 比例 电位 器 ， 该 电位 器 把 
输出 轴 转 过 的 角度 @ 转换 成 比例 的 电压 反馈 给 控制 电路 ， 控 制 电路 将 其 与 输入 的 控制 脉冲 信 
号 比较 ， 产 生 纠 偏 脉 冲 ， 并 驱动 电动 机 正 向 或 反 向 地 转动 ， 使 齿轮 组 的 输出 位 置 与 期 望 值 相 
符 ， 令 纠偏 脉冲 趋 于 0， 从 而 达到 使 通 机 精确 定位 的 目的 。 

给 舵 机 输入 一 个 周期 性 的 正 向 脉冲 信号 ， 这 个 周期 性 脉冲 信号 的 高 电 平 时 间 通 常 在 1 ~ 
2ms 之 间 ， 而 低 电 平时 间 应 在 5 ~20ms 之 间 ， 并 不 很 严格 ， 表 4-1 所 示 为 舵 机 的 输入 正 脉 冲 
宽度 与 舵 机 输出 轴 的 转角 的 关系 。 

表 4-1 输入 脉冲 宽度 与 输出 轴 的 转角 的 关系 
输入 正 脉 冲 宽度 〈 周 期 为 20ms) 直流 伺服 电动 机 输出 臂 位 置 





























0.5ms 
~ -90 








1.5ms 





~ 45 





2.5ms 


Gp EO a es a 





3. 使 用 舵 机 时 的 注意 事项 
普通 的 模拟 艇 机 不 是 一 个 精确 的 定位 器 件 ， 即 使 是 使 用 同一 品牌 型 号 的 艇 机 产品 ， 它 们 


67 


之 间 的 差别 也 是 非常 大 的 ， 在 同一 脉冲 宽度 驱动 时 ， 不同 的 能 机 答 出 位置 存在 +10° 的 偏差 
也 是 正常 的 。 

特别 注意 ， 绝 不 可 加 载 让 舵 机 输出 位 置 超过 +90° 的 脉冲 信和 号， 否则 会 损坏 舵 机 的 输出 
限 位 机 构 或 齿轮 组 等 机 械 部 件 。 

由 此 可 见 ， 艇 机 具有 以 下 一 些 特点 : 体积 紧凑 ， 便 于 安装 ; 输出 力矩 大 ， 稳 定性 好 ; 控 
制 简单 ， 便 于 和 数字 系统 接口 。 

正 是 因为 能 机 有 很 多 优点 ， 所 以 现在 不 仅仅 应 用 在 航模 运动 中 ， 已 经 扩展 到 各 种 机 电 产 
品 中 来 ， 在 机 器 人 控制 中 应 用 也 越 来 越 广泛 。 


4.4 将 舵 机 改装 成 执行 机 构 


众多 的 舵 机 生产 广 商 生 产 形 状 、 尺 寸 和 输出 力矩 各 异 的 艇 机 ， 从 市 场 上 可 以 购 得 的 舵 机 
数 以 百 计 。 在 选取 舵 机 时 一 般 应 该 考虑 以 下 问题 : 

1) 被 选择 的 舵 机 能 否 改 装 为 连续 转动 ; 

2) 输出 力矩 的 大 小 ; 

3) 是 否 人 允许 超过 额定 电压 的 限度 ; 

4) 转速 的 高 低 ; 

5) 如 何 控制 舵 机 。 

一 些 舵 机 即使 改装 之 后 也 无 法 变 为 连续 旋转 的 ， 因 为 其 花 键 齿轮 并 非 是 在 整个 圆周 上 都 
有 齿轮。 因此 选择 了 性 价 比 较 高 ， 同 时 也 是 比较 常见 的 Futaba S3003 舵 机 作为 行走 电动 机 。 

在 Futaba S3003 舵 机 中 有 一 个 限 位 装置 ， 使 得 舵 机 只 能 旋转 180° ， 而 竞赛 机 器 人 平台 的 
行走 电动 机 需要 连续 旋转 ， 需 要 将 Futaba S3003 舵 机 进行 改装 。 

1. 所 需 器 件 

1) 导线 ; 

2) BEB ; 

3) Futaba $3003 能 机 。 

2. 改装 工具 

1) Zl; 

2) 吸 锡 器 ; 

3) 60/40W 电 烙 铁 ; 

4) 小 螺钉 旋 具 ; 

5) Riya ttt. 

3. 改装 步骤 

舵 机 外 形 如 图 4-11 所 示 ， 按 以 下 步骤 改装 Futaba S3003 能 机 : 

1) 要 拆 掉 舵 机 的 顶 盖 ， 需 要 首先 用 小 螺钉 旋 具 拆 印 舵 机 的 舵 盘 。 舱 盘 是 用 螺钉 连接 在 
花 键 轴 上 的 ， 用 小 螺钉 旋 具 拧 松 螺 钉 以 后 舵 盘 就 和 花 键 轴 分 离 了 。 注 意 在 松 开 螺钉 时 一 定 要 
抓紧 和 通盘， 不 然 的 话 可 能 会 损坏 能 机 。 拆 御 后 的 舵 盘 和 舵 机 如 图 4-12 所 示 。 

2) 将 舵 机 翻转 ， 看 到 舵 机 的 底部 ， 如 图 4-13 所 示 。 使 用 小 螺钉 旋 具 拧 松 底面 的 螺钉 。 

3) 抓紧 外 壳 ， 并 将 外 壳 按 向 花 键 轴 ， 拆 下 项 盖 。 注 意 保护 舵 机 顶部 外 露 的 其 他 齿轮 。 
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图 4-11 Futaba S3003 能 机 外形 図 





图 4-12” 拆 掉 舵 盘 的 能 机 和 小 螺钉 旋 具 





图 4-13 舵 机 底部 
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能 机 内 部 的 齿轮 组 如 图 4-14 所 示 。 





E 4-14 舵 机 齿轮 组 
4) 如 图 4-15 所 示 ， 拆 除 黑色 的 花 键 齿轮 以 及 上 方 的 白色 齿轮 。 将 舵 机 内 部 齿轮 组 取 下 
来 以 后 ， 可 以 看 到 一 个 金属 矩形 块 ， 它 是 反馈 电位 需 的 调整 片 ， 可 以 通过 它 来 调整 和 设 定 能 
机 的 中 心 点 。 








图 4-15 拆 掉 的 花 键 齿轮 
5) 如 图 4-16 所 示 ， 将 花 键 齿轮 放 在 一 个 平 的 硬 质 表面 上 ， 小 心地 将 刻 刀 放 到 齿轮 上 ， 
保持 与 齿轮 面 平行 。 切 除 止 动 齿 一 直 切 到 主轴 ,但 不 要 切 得 过 深 ， 以 免 影 响 主轴 的 转动 。 不 











要 用 侦 口 钳 之 类 的 切割 器 切除 止 动 亏 ， 和 否则 其 轮 会 因为 受 力 不 均 而 破碎 ， 这 样 做 的 后 果 是 操 
作者 很 难 预料 哪些 齿轮 在 切除 止 动 齿 后 仍 安然 无 盖 ， 而 哪些 会 破损 。 
6) 切除 止 动 上 后 和 需要 使 用 简易 思 具 修整 齿轮 轮廓 ， 修 正 后 的 花 键 齿轮 如 图 4-17 所 示 。 
7) 舵 机 顶 盖 如 图 4-18 所 示 ， 为 了 使 舵 机 可 以 作 圆 周 运 动 ， 需 要 用 刀具 切除 项 盖 两 侧 的 
限 位 齿 。 在 切除 限 位 齿 的 过 程 中 应 该 特别 小 心 ， 注 意 保持 项 盖 表 面 的 平整 。 图 4-19 为 切除 
限 位 齿 的 项 盖 内 部 结构 。 
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图 4-16 舵 机 的 止 动 齿 





图 4-17 拆除 限 位 的 舵 机 止 动 齿 





Al4-18 fens 
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图 4-19 PERRE ELIT 
8) AENLAR TE UL AS is AE ER SCRE ELSE A SRR, 其 
中 两 根 为 电源 线 ， 一 根 为 信号 线 。 将 这 三 根 线 全 部 剪断 ， 然 后 将 其 中 的 两 根 电源 线 直 接 接 到 
电动 机 的 两 个 端子 上 ， 如 图 4-20 所 示 。 





图 4-20 “拆除 底 善后 的 舵 机 





图 4-21 修改 电路 后 的 舵 机 
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9) 重 装 舱 机 之 前 需要 确定 花 键 齿 轮 是 否 可 以 连续 转动 。 如 果 在 转动 过 程 中 有 摩擦 ,或 
者 有 轻微 的 上 下 的 振动 ， 说 明 在 转动 过 程 中 艇 机 的 止 动 齿 与 顶 六 的 限 位 齿 之 间 有 干涉 ， 需 要 
再 重新 修整 一 下 艇 机 的 止 动 估 和 顶 盖 的 限 位 齿 ， 直 到 可 以 连续 平滑 地 转动 花 键 齿轮 为 
止 。 

10) 小 心地 合 上 舵 机 的 顶 盖 ， 拧 紧 螺 钉 ， 直 到 舵 机 壳 体 与 顶 盖 紧密 贴 合 。 至 此 ， 改 装 
Futaba S3003 舵 机 的 工作 即 告 完工 ， 如 图 4-21 所 示 。 


4.5 竞赛 机 器 人 平台 的 组 装 


前 面 已 经 介绍 了 将 舵 机 改装 成 直流 电动 机 的 方法 ， 这 一 方 将 要 介绍 如 何 搭建 起 竞赛 机 器 
人 平台 。 考 虑 到 机 器 人 所 要 实现 的 功能 ， 这 里 将 竞赛 机 器 人 平台 的 结构 设置 为 双 层 结构 ， 每 
层 结构 都 有 一 层 印 制 电 路 板 (PCB) 构成 。 这 样 既 完 成 了 电路 部 分 的 设计 制作 ， 又 搭建 起 了 
Tote AMPEG. PCB 分 为 两 层 ， 下 层 是 驱动 板 ， 上 层 是 控制 板 。 

竞赛 机 器 人 驱动 板结 构图 如 图 4-22 所 示 ， 主 要 包括 : 左右 车 轮 、 两 个 改造 后 的 舵 机 、 
四 个 色差 传 感 姻 、 万 向 轮 、 电 气 连接 持 座 、H 桥 驱 动 蕊 片 等。 驱动 板 的 功能 是 : 接受 控制 板 
来 的 控制 信和 号， 驱动 两 台 直 流 电 动机 ， 完 成 竞赛 机 器 人 的 前 进 、 原 地 左 转 、 原 地 右 转 、 停 
止 、 后 退 。 

驱动 板 层 与 舵 机 通过 角钢 来 连接 ， 在 固定 时 需要 在 舵 机 与 螺栓 之 间 放 两 个 垫 片 。 垫 片 一 
般 用 在 连接 件 中 ， 一 个 是 软 质地 的 ， 男 一 个 是 硬 质地 较 脆 的 ， 其 主要 作用 是 增 大 接触 面积 ， 
分 散 压力 ， 防 止 把 质地 软 的 压 坏 。 这 里 垫 片 还 有 一 个 作用 就 是 防止 松动 。 但 若 安装 不 当 ， 则 
不 会 起 到 防止 螺栓 松动 的 作用 。 正 确 的 安装 方向 应 该 是 将 弹簧 垫 片 的 凹面 朝向 连接 件 ， 吓 面 
朝向 螺母 。 这 样 螺母 拧紧 后 ， 由 于 垫 片 受 力 变形 ,支撑 表面 受到 反作用 力 而 起 到 锁 紧 的 作 
用 








舵 机 与 轮子 的 连接 是 通过 一 个 黑色 的 连接 件 组 装 起 来 的 ， 如 图 4-23 所 示 。 连 接 件 相对 
较 小 ， 将 连接 件 与 轮子 直接 组 装 起 来 并 不 容易 ， 因 此 在 组 装 的 过 程 中 先 将 连接 件 装 在 舵 机 的 
舵 盘 上 ， 然 后 再 将 舵 机 上 的 连接 件 装 在 轮子 上 。 安 装 好 的 轮子 如 图 4-24 所 示 。 





图 4-22 竞赛 机 器 人 驱动 板 图 4-23 ”能 机 、 轮 子 与 连接 件 
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在 安装 好 轮子 以 后 ， 将 整体 固定 在 底层 驱动 板 上 ， 固 定 的 过 程 中 仍然 要 注意 在 螺母 与 电 
路 板 的 连接 处 加 一 个 垫 片 ， 防 止 将 电路 板 压 坏 。 图 4-25 为 组 装 以 后 的 底层 驱动 板 全 貌 。 

竞赛 机 器 人 控制 板结 构图 如 图 4-26 所 示 ， 
控制 板 层 主要 包括 CPU 单元 、 传 感 器 调理 电 
路 、 遥 控 器 无 线 接收 单元 、RS232 通信 和 电路、 
串 行 口 编程 座 等 部 分 。 

控制 板 的 功能 如 下 : 

1) 调理 四 个 红外 传感器 来 的 信号 。 

2) 处 理 四 个 红外 传感器 来 的 信号 ， 通 过 
智能 判断 程序 ， 决 定 竞赛 机 器 人 的 运动 状态 。 

3) 把 电源 电压 稳 压 成 单片机 可 以 正常 工 上 
作 的 电压 以 及 给 电池 进行 充电 。 

4) 遥控 接收 模块 接收 到 遥控 器 发 射出 来 图 4.24 安装 好 的 轮子 
的 信 导 ， 执 行 遥控 器 的 命令 。 








图 4-25 ”底层 驱动 板 全 貌 图 4-26 “竞赛 机 器 人 控制 板结 构 





5) 接收 上 位 机 来 的 信号 ， 执 行 上 位 机 的 命令 (包括 迷宫 的 指定 路 径 ， 前 后 左右 等 方向 


信息 ) ， 具 体 命令 参见 表 4-2。 
表 4-2 上 位 机 来 的 命令 





















































功能 1# 电 动机 (左側 ) 2# 电 动机 (右側 ) 备注 
1 前 进 正 转 正 转 相同 的 速度 
2 左 转 减速 正 转 加 速 正 转 
3 右 转 加 速 正 转 减速 正 转 
4 180° 正 转 反 转 车 的 中 心 不 变 
5 停车 给 0V 电压 给 0V 电压 制 动 
如 图 4-1 所 示 。 层 与 层 之 间 用 标准 铜 柱 文 撑 ， 电 气 连接 采用 标准 插 针 插座 连接 ， 便 于 拆 


装 和 维护 。 
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4.6 ”竞赛 机 器 人 专用 逮 控 器 的 制作 


迷宫 机 器 人 的 运动 方式 共 分 为 前 进 、 倒 退 、 左 转 和 右 转 ， 故 选用 手柄 式 的 遥控 器 最 为 人 
性 化 ,便于 操作 。 但 是 市 面 上 没有 手柄 式 的 膛 控 絮 ， 因 此 需要 对 从 市 场 上 买 到 的 遂 控 器 进 行 
改装 。 下 面 就 介绍 一 下 如 何 将 它 装 到 手柄 中 。 

1. 所 電器 件 

1) SPACE Mem (PFCR IEA), SEWE 4-27 所 示 ; 





图 4-27” 待 改装 的 遥控 器 外 形 
2) 手柄 ， 外 形 如 图 4-28 所 示 : 
3) 导线 ; 
4) 若干 焊锡 丝 。 





图 4-28 手柄 外形 


2. 牙 装 工具 
1) 小 螺钉 旋 具 ; 
2) 60/40W 电 烙铁 ; 


3) 万 用 表 ; 
4) 吸 锡 器 。 
3. 改装 步骤 
1) 用 螺钉 旋 具 将 待 改 装 的 遥控 器 背面 的 螺钉 松 开 ， 打 开 遥 控 吉 后 盖 ， 取 出 其 中 的 PCB 


( 印 制 电路 板 ) 。 可 发 现在 PCB 上 有 四 个 按键 ， 如 图 4-29 所 示 。 
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图 4-29 遥控 器 内 部 视图 

2) 每 个 按键 有 四 个 引 脚 ， 利 用 万 用 表 可 检测 出 当 按 键 按 下 时 ， 哪 两 个 引 脚 由 断 开 变 为 

接 通 ， 将 这 两 个 引 脚 记 住 ， 以 备 后面 所 用 ， 之 后 将 按键 除去 。 对 四 个 按键 都 按 此 步 处 理 ， 注 
意 不 要 损坏 PCB 

3) 用 螺钉 旋 具 将 手柄 背面 的 螺钉 松 开 ， 打 开 手 柄 后 盖 ， 取 出 其 中 的 PCB， 如 图 4-30 所 

示 。 注 意 打开 后 盖 时 要 小 心 按键 掉 落 。 











图 4-30 手柄 内 部 视图 


4) 将 手柄 中 PCB 上 的 全 部 芯片 以 及 导线 除去 。 

5) 若 希 望 手柄 左 侧 的 方向 键 与 右 侧 的 四 个 键 功 能 同步 ， 即 有 相同 的 功能 。 可 将 手柄 内 
的 PCB 左右 两 侧 对 应 的 触 板 用 导线 连通 。 

6) 将 遥控 器 中 的 按键 上 所 作 标 记 的 引 脚 与 手柄 内 的 PCB 上 的 按键 触 板 对 应 相连 。 即 作 
标记 的 引 脚 之 一 与 触 板 左 板 片 相连 ， 男 外 一 个 引 脚 与 触 板 右 板 片 相 连 。 注 意 遥 控 器 上 的 按键 
与 手柄 的 方向 键 的 功能 一 一 对 应 ， 如 图 4-31 所 示 。 

7) 将 电池 焊 在 对 应 位 置 ， 将 改装 好 的 PCB 装 回 手柄 内 ， 拧 紧 螺 多 ， 改 装 完成 。 
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图 4-31 手柄 PCB 与 遥控 器 PCB 间 的 连接 
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Se 竞赛 机 侣 人 的 电子 电器 





上 一 章 介绍 了 竞赛 机 器 人 的 整体 结构 的 设计 ， 也 就 是 机 器 人 有 了 自己 的 “骨架 ”， 但 是 
还 不 能 运动 起 来 ， 还 需要 将 “骨架 ” 连 起 来 组 合成 一 个 整体 ， 从 而 实现 对 机 器 人 的 控制 。 
硬件 电路 就 是 实现 这 样 的 一 个 功能 ， 下 面 就 来 介绍 一 下 机 器 人 平台 的 硬件 电路 设计 。 


5.1 硬件 电路 组 成 


TERNUARA REFERAR: 执行 机 构 驱 动 电路 、 色 差 传 感 器 检测 原理 、 迷 富 隔 顶 检 
测 、 无 线 发 射 接收 模块 、 串 行 口 传输 模块 、 数 据 存 储 模块 、 迷 宫 场 地 。 


5.2 执行 机 构 驱 动 电路 


经 过 改造 后 的 舵 机 相当 于 带 减 速 箱 的 直流 电动 机 。 由 于 舵 机 的 性 能 优越 ， 舵 机 的 一 致 性 
好 ， 当 两 个 电动 机 加 同样 的 电压 时 ， 电 动机 的 转速 基本 一 致 ， 误 差 很 小 。 直 流 电动 机 的 物理 
模型 如 图 5-1 所 示 。 其 中 ， 固 定 部 分 有 磁铁 ， 这 里 称 作 主 磁极 ; 固定 部 分 还 有 电 刷 。 转 动 部 
分 有 环形 铁心 和 绕 在 环形 铁心 上 的 绕组 。 图 5-1 表示 一 台 最 简单 的 两 极 直流 电动 机 模型 ， 它 
的 固定 部 分 (定子 ) 上 ， 装 设 了 一 对 直流 励磁 的 静止 的 主 磁极 N 和 S， 在 旋转 部 分 (转子 ) 
上 装 设 电 枢 铁 心 。 定 子 与 转子 之 间 有 一 气 际 。 在 电 枢 铁 心 上 放 置 了 由 导体 连 成 的 电 枢 线 圈 ， 
线圈 的 首 端 和 末端 分 别 连 到 两 个 圆 弧 形 的 铜 片上 ， 此 铜 片 称 为 换 向 片 。 换 向 片 之 间 互 相 绝 
缘 ， 由 换 向 片 构成 的 整体 称 为 换 向 器 。 换 向 器 固定 在 转轴 上 ， 换 向 片 与 转轴 之 间 亦 互相 绝 
缘 。 在 换 向 片上 放置 着 一 对 固定 不 动 的 电 刷 B1 和 B2 ， 当 电 枢 旋转 时 ， 电 枢 线圈 通过 换 向 片 
和 电 刷 与 外 电路 接 通 。 













































































主 磁极 








Odd Qa 


图 5-1 直流 电动 机 的 物理 模型 
设 原 动机 拖 动 转子 转速 为 n， 电 动机 内 部 的 固定 部 分 要 有 磁场 。 这 个 磁场 是 由 图 5-1 所 
示 的 永久 磁铁 和 磁极 铁心 上 绕 套 的 线圈 ， 再 通过 直流 电 产 生 的 。 其 中 ,i 为 励磁 电流 。 这 种 
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AeA MIR LAT, 也 就 是 , HULA Le i AL a PE), KL Fd FB 
(或 并 联 ) 起 来 就 构成 了 励磁 绕组 。 这 里 要 注意 各 线圈 通过 电流 的 方向 不 可 出 错 。 在 以 上 条 
件 下 环 外 导体 将 感应 电动 势 ， 其 大 小 与 磁 通 密度 如、 导体 的 有 效 长 度 ! 和 导体 切割 磁场 速度 
v 三 者 的 乘积 成 正比 ， 其 方向 用 右手 定 则 判断 。 对 某 一 根 转子 导体 的 电动 势 性 质 是 交流 电 ， 
而 经 电 刷 输出 的 电动 势 却 是 直流 电 了 。 这 便 是 直流 电动 机 的 工作 原理 。 
竞赛 机 器 人 的 电动 机 需要 正 反 转 控 
制 ， 为 此 这 里 采用 L298 双 通 道 直流 电动 
机 驱动 芯片 来 驱动 。L298 是 一 块 单 片 集 
成 电路 ， 有 两 种 封装 形式 : 15 脚 直立 封 
装 ( Multiwattl5 ) 和 20 脚 贴 片 封 装 
(PowerS020)， 如 图 5-2 所 示 。L298 是 
双 H 桥 高 电压 大 电流 功率 集成 电路 ， 可 
以 用 来 驱动 2 个 直流 电动 机 ， 也 可 以 用 15-2 1258 ROA ae 
来 驱动 感性 负载 ， 如 继电器 、 电磁 阀 、 a) Multiwatt15 b) PowerSO20 
进 电动 机 等 。 采 用 L298 作为 电动 机 驱动 电路 ， 可 靠 性 高 ， 可 以 方便 地 控制 电动 机 的 正 反 转 。 
L298 有 两 个 独立 的 使 能 端 ， 其 内 部 框图 如 图 5-3 所 示 。 


OUTPUT1 OUTPUT2 +s OUTPUT3 OUTPUT4 














a) b) 
































INPUT4 
ENABLEB 








CURRENT SENSINGB 














图 5-3 L298 内 部 框图 
1298 引 脚 排列 如 图 54 所 示 。 特 别 要 注意 图 中 看 起 来 是 短 的 引 脚 ， 实 际 是 弯 的 引 脚 。 








CURRENT SENSINGB 
OUTPUT 4 
OUTPUT 3 
INPUT 4 
ENABLE B 
INPUT 3 
LOGIC SUPPLY VOLTAGE Veg 
GND 
INPUT 2 
ENABLE A 
INPUT 1 
SUPPLY VCL TAGE Vs 
D 3 OUTPUT 2 
OUTPUT 1 
CURRENT SENSING A 


图 54 1298 的 引 脚 排列 


IMultiwatt15 
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L298 引 脚 名 称 和 功能 见 表 5-1 。 
表 5-1 L298 引 脚 名 称 和 功能 




































































































































































MW. 15 名 称 功能 说 明 
1; 15 | CURRENTS SENSINGAS | 与 地 之 间接 检测 电阻， 用 来 控制 负载 电流 
CURRENT; SENSINGB 
2; 3 OUTPUT! ; OUTPUT2 AH 桥 的 输出 端子 ， 这 两 个 端子 流 过 负载 电流 
4 V, 功率 输出 的 电源 电压 端子 
Cy INPUT1; INPUT2 AH 桥 的 TTL 电 平 输入 
6; 11 ENABLEA; ENABLEB 使 能 端子 
8 GND 电源 地 
9 Veg 逻辑 电源 电压 端子 
10; 12 INPUT3 , INPUT4 BH 桥 的 TTL 电 平 输入 
13; 14 OUTPUT3 ; OUTPUT4 BH 桥 的 输出 端子 ， 这 两 个 端子 流 过 负载 电流 














L298 内 部 设计 了 两 个 可 以 接受 标准 的 TTL 逻辑 电 平 的 高 工作 电压 、 高 工作 电流 的 全 H 
桥 驱 动 电路 。 功 率 电源 电压 V. 范围 为 2.5 ~46V， 逻 辑 电 源 电 压 VV 工作 范围 : 5 ~7V。 最 大 
静态 工作 电流 是 70mA (V,=42V, V。=5V, 7T =25%C ) 。 

L298 的 主要 参数 : 

1) 允许 驱动 电压 : V, =SOV; 

2) 允许 控制 电压 : V, =50V 

3) 直流 允许 输出 电流 : loma =2A; 

4) 直流 最 大 允许 尖峰 电流 : logea =3A (t=100ps) ; 

5) 允许 采样 电压 : Vense = -1~2.3 V; 

6) 人 允许 功 耗 : Poa =25W Tag =75 て ) 。 

注意 : 1298 每 一 路 输出 正常 可 以 提供 2A 的 电流 ， 峰 值 电流 (100ps 之 内 ) 可 达 4A。 

竞赛 机 器 人 的 驱动 电路 如 图 5-$ 所 示 。 


























M1 
MOTOR La 2 inputl outputl et 
MOTOR 2A mpe 
MOTOR 2B mpy 
input4 L298 = 
output2 
MOTOR EN EnableA M2 





EnableB output3 





output4 





图 5-5 竞赛 机 器 人 的 驱动 电路 


80 





HHF, M, M 是 直流 电动 机 ; VDI ~ VD8 是 整流 二 极 管 。 当 Enable A 和 Enable B 使 能 
端 为 高 电 平 、 输 入 端 inputl 、input2 分 别 为 1、0 時 , MI 正 转 ; inputl input? 分 别 为 0、1 
EF, M1 反 转 。 同 理 input3 、input4 分 别 为 1、0 时 ，M2 正 转 ; input3 、input4 分 别 为 0、1 
时 ，M2 反 转 。 葛 赛 机 器 人 的 运动 状态 见 表 5-2。 

R52 竞赛 机 器 人 的 运动 状态 









































ENABLE A 
INPUT1 INPUT2 INPUT3 INPUT4 左轮 右 轮 状态 

ENABLE B 
均 为 0 x x x x 静止 静止 静止 
均 为 1 0 0 0 0 静止 静止 停止 
均 为 1 0 1 1 0 正 转 正 转 前 进 
均 为 1 0 1 0 0 正 转 翻转 右 转 
均 为 1 1 0 1 0 反 转 正 转 左 转 





















































注 : 0 为 低 电 平 ，! 为 高 电 平 ，x 为 任意 电 平 。 


5.3 传感器 检测 电路 


传感器 是 以 一 定 的 准确 度 把 被 测量 转换 为 与 之 有 确定 对 应 关系 的 、 便 于 应 用 的 另 一 种 量 
的 一 种 测量 装置 。 换 一 种 说 法 ， 传 感 器 是 把 非 电 量 转换 成 电量 的 装置 。 传 感 器 通常 由 敏感 元 
件 、 转 换 元 件 和 测量 电路 三 部 分 组 成 。 敏 感 元 件 是 指 能 直接 感受 (或 响应 ) 被 测量 的 部 分 ， 
即将 被 测量 通过 传感器 的 敏感 元 件 转换 成 与 被 测量 有 确定 关系 的 非 电 量 或 其 他 量 。 转 换 元 件 
则 将 上 述 非 电 量 转 换 成 电 参 量 。 测 量 电路 的 作用 是 将 转换 元 件 输入 的 电 参 量 经 过 处 理 ， 转 换 
成 电压 、 电 流 或 频率 等 可 测 电量 ， 以 便 进 行 显示 、 记 录 、 控 制 和 处 理 。 测 量 电路 中 ， 较 多 使 
用 电 桥 电路 。 应 该 注意 的 是 ， 有 些 敏 感 元 件 可 以 直接 输出 电 参 量 ， 也 就 是 说 ， 没 有 人 敏感 元 件 
与 转换 元 件 之 分 。 

我 们 可 以 这 样 理解 : 传感器 是 测量 装置 ， 能 完 
成 检测 任务 ; 传感器 的 输入 量 是 某 一 被 测量 ， 比 如 
物理 量 、 化 学 量 、 生 物 量 等 ; 传感器 的 输出 量 是 某 > 
种 被 测量 ， 这 种 量 要 便于 传输 、 转 换 、 处 理 、 显 示 
等 ， 例 如 气 、 光 、 电 量 等 ;传感器 的 输入 和 输出 有 开关 
对 应 的 关系 ， 且 有 一 定 的 准确 度 。 

如 图 5-6a 所 示 ， 假 如 开关 闭合 ， 灯 就 会 被 点 a) 
seo MIR, 把 井 共 断 井 , WARS BERK. WI 图 5.6 传感器 示意 图 
5-6b 所 示 ， 如 果 这 个 开关 不 是 用 手 来 控制 开 或 者 a) 用 手 控 制 开关 电路 b) 用 传感器 控制 电路 通 断 
关 的 ， 而 是 由 外 部 的 因素 决定 ， 比 如 光 、 声 等 ， 那 
么 这 个 开关 就 变 成 了 一 个 传感器 。 
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5.3.1 起 跑 线 的 检测 


常用 的 竞赛 智能 车 巡 线 方案 有 光电 传感器 阵列 和 CCD 探测 法 等 ， 这 里 只 介绍 光电 传 感 
器 阵列 的 设计 方案 。 光 电 传 感 咒 是 由 红外 发 射 管 和 红外 接收 管 组 成 的 传感器 ， 如 图 5-7 所 
示 o 
红外 接收 管 红外 发 射 管 红外 接收 管 红外 发 射 管 


© 






白色 反射 面 黑色 反射 面 

















图 5-7 ”红外 传感器 地 面 颜 色 识别 原理 





红外 发 射 管 发 射 的 红外 线 具 有 一 定 的 方向 性 ， 当 红外 线 照射 到 白色 表面 上 时 会 有 较 大 的 
RI, WRES D, 取 值 合适 ， 则 红外 接收 管 可 接收 到 反射 回 的 红外 线 ， 再 利用 红外 接收 管 
的 电气 特性 ， 在 电路 中 处理 红外 线 的 接收 信息 ; 如 果 反射 表面 为 黑色 ， 则 红外 光 会 被 表面 将 
其 大 部 分 吸收 ， 红 外 接收 管 就 难以 收 到 红外 线 。 这 样 ， 就 可 以 利用 红外 收发 管 组 成 的 光电 传 
感 器 检测 区 分 赛 道 上 的 黑白 线 ， 实 现 智能 车 的 巡 线 方案 。 


5.3.2 迷宮 隔 柳 栓 測 部 分 


用 于 竞赛 机 器 人 比赛 的 场地 如 图 5-8 所 示 ， 竞 赛 机 器 人 需要 准确 地 检测 迷宫 隔 栅 的 有 无 
及 距 隔 栅 的 距离 。 





图 5-8 竞赛 机 器 人 走 迷 宫 的 比赛 场地 


1. 迷宫 隔 栅 检测 电路 
迷宫 隔 栅 检 测 电路 如 图 5-9 所 示 ， 品 体 管 V1 用 来 驱动 红外 发 射 管 ， 红 外 接收 管 接收 迷 
富 隔 栅 反 射 回来 的 红外 光 ， 并 转化 为 对 应 的 电压 信号 VW,， 经 过 电压 跟随 器 放大 隔离 ， 最 后 
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输出 与 测量 距离 x 对 应 的 电压 Voo 


R39 ray outl 










RAYIA 
RAY_RC_TX Vcc 



























LM358P や 
R163 HE Vout 
100k 1 ray inl 
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图 5-9 迷宫 隔 顶 检 测 电路 

传感器 采用 红外 光 调 制 解 调 技术 ， 大 大 增强 抗 干扰 能 力 ， 能 准确 检测 出 有 无 隔 栅 。 其 工 
作 原 理 是 : 通过 红外 发 射 管 发 射 特定 频率 的 红外 线 ， 当 照射 到 隔 栅 上， 就 会 发 生 反 射 ， 红 外 
接收 管 不 断 检测 反射 光 ， 从 而 实现 对 物体 的 检测 。 红 外 信号 需要 调制 到 38kHz 的 载波 上 ， 这 
样 , 一 方面 与 生活 中 常见 的 普通 红外 线 区 别 开 来 ， 男 一 方面 可 以 增 大 检测 距离 。 红 外 接收 电 
路 采用 型 号 为 TSOP1738 的 红外 线 接收 管 ， 其 内 部 已 经 集成 了 专用 电路 ， 具 有 调谐 、 放 大 和 
检测 信号 的 功能 。TSOP1738 的 红外 线 接收 管 的 输出 是 解 调 出 来 的 电 平 信号 ， 可 以 直接 输入 
单片机 ， 使 用 非常 方便 。 参 考 电 路 如 图 5-10 所 示 。 


R13 


























SEN-RAYH1 SEN-RAYH1 








图 5-10 ”红外 传感器 的 调制 发 射 和 接收 

红外 线 是 一 种 只 有 少数 生物 才能 感觉 到 的 光波 ， 其 波长 为 1 ~1000nm， 具有 定向 传播 
和 反射 能 力 。 移 动机 器 人 上 的 红外 传 感 恬 探测 原理 为 : 红外 传 感 句 发 出 红外 信和 号 并 检测 
返回 的 信号 ， 通 过 返回 信号 的 强度 并 依据 环境 物体 的 反射 系数 估计 传感器 本 身 到 目标 物 
体 的 距离 ， 红 外 传感器 的 探测 特性 与 超声 传感器 相反 ， 即 角度 分 辨 率 高 ， 而 距离 分 辨 率 
低 。 当 然 ， 它 同样 具有 灵敏 度 高 、 响 应 速度 快 、 结 构 简 单 、 成 本 低 等 优点 ， 其 缺点 是 探 
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测 距 离 依赖 于 物体 反射 的 光 强 度 。 在 环境 未 知 的 情况 下 ， 环 境 中 的 障碍 物 的 反射 系数 是 
无 法 估计 和 确定 的 。 

2. 驱动 红外 发 射 管 的 脉冲 信号 

红外 发 射 管 发 射 的 是 光 脉 冲 信 号 ， 如 图 5-11 所 
示 。 四 个 红外 发 射 管 轮流 发 射 ， 提 高 了 抗 干扰 能 
脉冲 的 频率 为 40kHz， 高 电 平 时 间 是 5ms， 低 电 平 时 间 
是 20ms。 采 用 罕 脉 冲 驱动 红外 发 射 管 ， 可 以 提高 检测 
的 可 靠 性 。 

驱动 红外 发 射 管 的 罕 脉 冲 发 射电 流 的 幅 值 是 : 7 = 
(Vae -Vee — Vay ou) AR=50mA。 脉 冲 的 占 空 比 是 g = 1/4. 
平均 发 射电 流 是 50/4mA = 12.5mA, 

3. 检测 隔 栅 的 四 个 传感器 的 布置 


竞赛 机 器 人 检测 隔 栅 的 四 个 传感器 的 布置 如 图 5-2 ur 
所 示 。 基 中 , 1 号 用 来 检测 左 侧 隔 栅 ，2 号 、3 号 用 来 检 HoA ii 
WRA, 4 号 用 来 检测 右 侧 隔 栅 。 测 距 方面 采用 模 | 日 























拟 传感器 ， 解 决 探测 墙壁 的 有 无 和 沿 着 跑道 中 线 前 进 的 7 
问题 。 图 5-11 红外 发 射 管 发 射 的 脉冲 信和 号 





图 5-12 ”检测 隔 栅 的 四 个 传感器 的 布置 





5.3.3 传感器 的 特性 曲线 


为 了 了 解 传 感 器 输出 电压 Voa SMER x 之 间 的 关系 ， 做 了 大 量 的 试验 。 首 先 需要 校 
基准 ， 依 次 将 竞赛 机 右 人 的 传感器 放置 于 距 迷 宫 隔 栅 35mm 处 ， 通 过 示 波 右 观察 输出 电压 
Vi 的 波形 ， 如 图 5-13 所 示 ， 仔 细 调 整 可 调 电 位 器， 使 输出 所 ,为 2 0V。 调 整 传 感 需 与 迷宫 
隔 栅 的 间距 ， 每 改变 Smm 的 距离 ， 记 录 一 次 输出 电压 内 ， 试 验 数据 见 表 5-3。 
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5-3 传感器 输出 电压 Vo 与 检测 距离 x 之 间 的 关系 










































































传感器 编号 距离 /cm 0 0.5 1 1.5 2 2:5 3 3.5 4 4.5 5 
1# 3.3 3.3 3.3 3.3 3.2 2.9 2.4 2.0 1.75 1.5 1.35 
2# 3.3 3.3 3.3 3.3 3.2 2.9 2.4 2.0 1.75 1.5 1.4 
输出 电压 AV 
3# 3.3 3.3 3.3 3.2 3.2 2.75 2.4 2.0 1.8 1.55 1.4 
4# 3.3 3.3 3.25 3.25 3.15 2.7 2.4 2.0 1.8 1.7 1.5 
传感器 编号 距离 /cm 5.5 6 6.5 7 i Pes) 8 8.5 9 9.5 10 20 
1# 1.2 1.1 1.05 0. 95 0.8 0.8 0. 75 0.7 0.7 0. 65 
2# 1.5 1.3 1.25 1.15 1.1 1.05 1 0.95 0.9 0. 85 
输出 电压 AV 
3# 1.3 1.2 1.1 1.0 0.9 0.9 0.8 0. 75 0. 75 0. 75 
4# 1.45 3 1.25 1.2 1.1 1.1 1.0 0.9 0.9 0.9 0.7 
= ZS SA») » y: $ X 
VERRA M H 电压 Vo 与 检测 距离 x 之 间 的 关系 曲 线 Tek JL @ Stop Mpos-4.600ms 
ak n HTTTTWIITIITITTITTITTTTTTTT ロ 
如 图 5-14 所 示 。 he See res 


从 图 5-14 可 以 看 出 ， 每 组 发 射 接收 传感器 的 变化 
趋势 基本 一 致 。 由 于 迷宫 的 跑道 宽 约 为 17.2cm， 小 车 
宽 为 10cm， 竞 赛 机 器 人 在 跑道 的 中 线 时 ， 左 右 传 感 右 
距 跑 道 边 的 距离 约 是 3. Sem。 以 左 侧 传感器 (1#) 为 
例 ， 从 表 5-3 及 图 5-14 的 曲线 可 以 看 出 : 

1) 当 检 测 距 离 x > 8. 5cm 时 ,检测 电压 Va < 
1.0V， 说 明 左 侧 没有 隔 栅 。 

2) 当 检 测 距 离 x<3cm It, Vi, >2.4V, WEZE 图 5-13” 校 基准 的 波形 
机 器 人 偏离 中 线 ， 向 左 偏 了 。 
3) 当 检 测 距离 x >4cm Hf, Vi, <1. 75V, 说明 竞 赛 机 器 人 偏离 中 线 ， 向 右 偏 了 。 

以 2# 传 感 器 为 例 ， 当 检测 距离 x <2cm 时 ， 检 测 电压 内 .>3.0V， 说 明 传 感 器 前 方 有 隔 
WT (该 停车 或 转弯 了 ， 和 否则 要 碰 隔 栅 了 ) o 
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图 5-14 ”传感器 和 输出 电压 放 , 与 检测 距离 * 之 间 的 关系 曲线 
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5.3.4 沿 跑道 中 线 的 运行 


赛 道中 的 竞赛 智能 车 负责 治 中 线 前 进 的 方向 控制 是 根据 车 模 检 测 到 的 电磁 感应 电压 来 
生成 电动 机 差 动 控 制 量 的 。 通 过 左右 电动 机 速度 差 驱动 车 模 转 向 消除 车 模 距 离 道 路 中 心 
的 偏差 。 为 了 逐步 消除 车 模 距离 道路 中 心 线 的 距离 差 ， 可 通过 车 模 方 向 的 调整 及 车 模 的 
前 行 运动 来 完成 。 该 过 程 是 一 个 积分 过 程 ， 因 此 简单 的 比例 控制 就 可 以 进行 车 模 差 动 控 
制 ， 并 从 而 完成 车 模 的 方向 控制 。 但 考虑 到 车 模 自 身 安装 的 电池 等 比较 重 的 物体 ， 会 产 
生 较 大 的 转动 惯量 ， 所 以 车 模 在 调整 过 程 中 容易 出 现 转向 过 冲 现象 ， 此 现象 如 果 不 加 以 
抑制 ， 则 车 模 在 很 大 程度 上 会 冲 出 赛 道 。 为 了 能 更 准确 反映 车 模 重心 距离 电磁 线 的 距离 
差别 ， 避 免 角度 的 影响 ， 在 进行 方向 控制 时 ， 使 用 左右 两 个 线圈 感应 电动 势 之 差 除 以 左 
右 两 个 线圈 感应 电动 势 之 和 得 一 比值 ， 使 用 该 比值 进行 方向 控制 ， 可 以 消除 检测 线圈 对 
传感器 测量 角度 的 影响 。 


5.4 无线 发 射 接收 模块 


通过 无 线 遥 控 器 可 以 控制 机 器 人 的 起 动 、 停 止 、 前 进 、 左 转 、 右 转 、 功 能 设 定 等 ， 竞 赛 
机 器 人 的 遥控 器 如 图 5-15 所 示 。 —— 
面板 上 有 A、B、C、D 四 位 按键 
及 一 个 发 射 指 示 灯 。 内 部 采用 进 
口 声 表 谐振 器 稳 频 ， 频 率 一 致 性 
非常 好 ， 稳 定 度 极 高 ， 工 作 频 率 
为 315MHz ， 频 率 稳 定 度 优 于 
10°°% ， 使 用 中 无 须 调 整 频 点 图 5.15 ”遥控 器 外 形 图 
(如 果 需 要 也 可 以 ) ， 使 用 极为 方 
便 。 

PT2262 编码 芯片 和 PT2272 解码 芯片 是 台湾 地 区 普 城 公司 生产 的 一 对 COMS 专用 编码 电 
芯片 ， 其 引 脚 图 如 图 5-16 所 示 ， 振 荡 频 率 通 过 一 个 外 接 电阻 进行 调节 。PT2262 的 引 脚 名 
称 兄 表 54, PT2272 的 引 脚 名 称 见 表 5-5, PT2262/PT2272 的 特点 见 表 5-6。 

表 5-4 PT2262 引 脚 名 称 和 功能 说 明 






































































































































名 称 引 脚 功能 说 明 
AO ~ All 1~8、10 ~13 于 进行 地 址 编码 ， 可 置 为 “0”“1”“ 人 和 CRS) 
D6 ~ D11 7, 8, 10 ~13 数据 输入 端 ， 有 一 个 为 “1”， 即 有 编码 发 出 

Vpp 18 电源 正 端 (+ ) 

Ve 9 电源 负 端 ( - ) 

TE 14 编码 启动 端 ， 用 于 多 数据 的 编码 发 射 ， 低 电 平 有 效 
OSC1 16 振荡 电阻 输入 端 ， 与 0SC2 所 接 电阻 决定 振荡 频率 
osc2 15 振荡 电阻 振荡 器 输出 端 

Dout 17 编码 输出 端 (正常 时 为 低 电 平 ) 
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表 5-5 PT2272 引 脚 名 称 















































































































































名 称 管 脚 说 HH 
AO ~ All 1 -8、10 -13 用 于 地 址 编码 ， 可 为 “0”、“1”、“fP” (RAS), ， 须 与 2262 一 致 
DO ~ D5 7, 8, 10 ~13 地 址 或 数据 引 脚 
Vop 18 电源 正 端 (+) 
Vs 9 电源 负 端 (-) 
DATAIN 14 数据 信号 输入 端 ， 来 自 接收 模块 输出 端 
OSC1 16 振荡 电阻 输入 端 ， 与 0SC2 所 接 电阻 决定 振荡 频率 
OSC2 15 振荡 电阻 振荡 顺和 输出 端 
VT 17 坚 码 有 效 确认 (正常 时 为 低 电 平 )， 解 码 有 效 变 成 高 电 平 ( 瞬 态 ) 
表 5-6 PT2262/PT2272 的 特点 
1 CMOS 工艺 制造 ， 低 功 耗 4 工作 电压 范围 宽 : 2.6 ~15V 
2 外 部 元 器 件 少 5 数据 最 多 可 达 6 位 
3 RC 振荡 电阻 6 地 址 码 最 多 可 达 531441 种 
编码 电路 PT2262 和 PT2272 的 第 
1 ~8 引 脚 为 地 址 设 定 脚 ， 可 以 选择 县 
空 、 接 正 电 源 、 接 地 三 种 状态 ，3 的 A2 
8 次 方 为 6561， 所 以 地 址 编码 不 重复 
度 为 6561 组 。 只 有 PT2262 和 PT2272 ek 

















的 地 址 编码 完全 相同 ， 才 能 配对 使 
用 。 

遥控 器 中 的 编码 电路 如 图 5-17 所 
示 ， 当 有 按键 按 下 时 ，PT2262 得 电 图 5-16 编码 芯片 PT2262 与 解码 芯片 PT2272 的 引 脚 图 
工作 , 其 第 17 脚 输出 经 调制 的 串 行 
数据 信号 ， 第 17 脚 为 高 电 平 期 间 ，315MHz 的 高 频 发 射电 路 起 振 并 发 射 等 幅 高 频 信 号 ， 第 
17 脚 为 低 平 期 间 ，315MHz 的 高 频 发 射电 路 停止 振荡 ， 所 以 高 频 发 射电 路 完全 受 控 于 
PT2262 的 第 17 脚 输出 的 数字 信和 号， 从 而 对 高 频 电路 完成 幅度 键 控 (ASK) 调制 ， 相 当 于 调 
制度 为 100% 的 调幅 。 

竞赛 机 器 人 主板 上 的 无 线 接 收 电路 如 图 5-18 所 示 。 其 中 ，PT2272 是 解码 芯片 。 妥 指 
DVS-9921 无 线 接收 模块 。DVS-9921 的 外 观 如 图 5-19 所 示 。 其 工作 电压 : 4.85 ~5.5V; T 
作 电 流 : 2.3mA 左右 ; 接収 距 高 : 120m 左右 ; 长 x 宽 x 厚 : 31.3mm x 14.4mm x 8mm, 
PT2262/PT2272 的 电气 参数 见 表 5-7。 

在 具体 的 应 用 中 ， 外 接 振 荡 电 阻 可 根据 需要 进行 适当 的 调节 ， 阻 值 越 大 ， 振 荡 频 率 越 
低 ， 编 码 的 宽度 越 大 ， 发 码 一 帧 的 时 间 越 长 。 网 站 上 大 部 分 产品 都 是 用 2262Hz/1. 2MHz/ 
2272Hz/200kHz 组 合 的 ， 少 量 产品 用 2262Hz/4. 7MHz/2272Hz/820kHz。 

PT2262 编码 芯片 发 出 的 编码 信号 由 地 址 码 、 数 据 码 、 同 步 码 组 成 一 个 完整 的 码 字 ， 
PT2272 解码 芯片 接收 到 信号 后 ， 其 地 址 码 经 过 两 次 比较 核对 后 ，VT 脚 才 输 出 高 电 平 ， 与 此 
同时 相应 的 数据 脚 也 输出 高 电 平 。 
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Vec 
+12V 
ale U2 PT2262 Vcc 
S1 ラー 0 
に シーマ 1 
S4 ee 2 
に コッ 3 
SS TE a 
ase 8 5 
S6 T 6 
Se 78 
EIS 
S-17 ”遥控 需 中 的 编码 电路 图 
/cc 
= CON4 
J3 : 无 线 接收 模块 
forward 
> PT2272-SO 
图 5$-18 ”竞赛 机 器 人 的 无 线 接收 模块 
5-19 ”竞赛 机 器 人 的 DVS-9921 无 线 接收 模块 
表 5-7 PT2262/PT2272 的 电气 参数 
电气 参数 符号 参数 范围 
电源 电压 /AV Voc -0.3 ~15 
输入 电压 /V V, -0.3 ~V.。 +0.3 
输出 电压 /V A -0.3 ~V,, +0.3 
最 大 功 耗 (Vee =10V) /mW T, 300 
工作 温度 /C Ten -20 ~ +70 
贮存 温度 /%C T -40 ~ +125 
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一 个 字 码 由 12 位 AD FS (地址 码 A 加 数据 码 D， 如 8 位 地 址 码 加 4 位 数据 码 ) 组 成 ， 
地 址 码 和 数据 码 都 用 宽度 不 同 的 脉冲 来 表示 : 两 个 窗 脉 冲 表 示 “0”; 两 个 宽 脉 冲 表示 “1”; 
一 个 窗 脉 冲 和 一 个 宽 脉 冲 表 示 “F"” ， 也 就 是 地 址 码 的 “悬空 ”， 如 图 5-20 所 示 ( 注 : 图 5- 
20 中 a 代表 两 个 时 钟 振荡 周期 ) 。 同 步 位 的 周期 是 128c， 脉 宽 是 4c， 如 图 5-21 所 示 。 


32a 


a |4=2Tosc 


位 “o” | | | | 
位 wy | | | | 
位 wg” | | | | 


图 $-20 “表示 地 址 码 和 数据 码 的 脉冲 





128a 


m i 


图 5-21 同步 位 示意 图 





每 组 字 码 之 间 由 同步 码 隔 开 ， 用 单片机 软件 解码 时 ， 程 序 只 要 判断 出 同步 码 ， 然 后 对 后 
面 的 字 码 进行 脉冲 宽度 识别 即 可 。PT2262 每 次 发 射 时 至 少 发射 4 组 字 码 ，PT2272 只 有 在 连 
续 两 次 检测 到 相同 的 地 址 码 加 数据 码 时 ， 才 会 把 数据 码 中 的 “1” 所 对 应 的 数据 输出 端 设 置 
为 高 电 平 ， 同 时 把 VT 端 设置 为 高 电 平 。 因 为 无 线 发 射 的 特点 是 第 一 组 字 码 非常 容易 受 零 电 
平 干 扰 ， 往 往 会 产生 误 码 ， 所 以 程序 可 以 丢弃 处 理 。 

PT2272 解码 蕊 片 的 后 级 有 14AM4AL6AM6 之 分 ， 其 中 工 表示 锁 存 输出 ，M 表示 非 锁 存 输 
出 ， 类 似 点 动 的 控制 。 后 级 的 6 和 4 表示 有 几 路 并 行 的 控制 通道 ， 当 采用 4 路 并 行 数据 
(PT2272-M4) 时 ， 对 应 的 地 址 编码 应 该 是 8 位 ; 如 果 采 用 6 路 的 并 行 数据 (PT2272-M6 ) , 
对 应 的 地 址 编码 应 该 是 6 位 。 


5.5 数据 存储 模块 


24C512 是 串 行 EEPROM 读 写 芯片 ， 是 通过 工 C 总 线 方式 通信 的 。IC 总 线 是 一 种 用 于 
IC 器 件 之 间 的 两 线 制 总 线 。 两 根 线 分 别 是 : SDA ( 串 行 数 据 ) 线 及 SCL (BAIN GP) 线 ， 
连接 到 总 线 上 的 工 C 器 件 之 间 可 以 传送 信息 ， 并 根据 地 址 识别 每 个 PC 器 件 ， 不管 是 单 片 
机 、 存 储 器 、LCD 驱动 器 还 是 键盘 接口 。 

LPC RARE 

串 行 扩展 总 线 技术 是 新 一 代 单 片 机 技术 发 展 的 一 个 显著 特点 。 其 中 PHILIPS 公司 推出 的 
PC 总 线 (INTEL IC BUS) 最 为 著名 。 与 并 行 扩展 总 线 相 比 ， 串 行 扩展 总 线 有 突出 的 优点 : 
电路 结构 简单 ， 程 序 编写 方便 ， 易 于 实现 用 户 系 统 软 硬 件 的 模块 化 、 标 准 化 等 。 目 前 工 C 总 
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线 大 量 应 用 在 视频 、 音 像 系统 中 ，PHILIPS 公司 推出 的 近 200 种 工 C 总 线 接口 器 件 ， 主 要 是 
视频 、 音 像 、 单 片 机 器 件 。[C 总 线 最 显著 的 特点 是 : 规范 的 完整 性 、 结 构 的 独立 性 和 用 户 
使 用 时 的 “傻瓜 ”化 。LC 总 线 有 严格 的 规范 ， 如 接口 的 电气 特性 、 信 号 时 序 、 信 号 传输 的 
定义 、 总 线 状态 设置 、 总 线 管理 规则 及 总 线 状态 处 理 等 。 

由 于 工 C 总 线 系统 中 ， 各 个 节点 的 电气 特性 及 地 址 给 定 都 具有 较 强 的 独立 性 ， 因 此 ， 在 
应 用 系统 中 采用 工 C 总 线 结构 就 有 可 能 实现 用 户 梦 霖 以 求 的 器 件 及 功能 单元 的 软 、 硬 件 标准 
化 和 模块 化 设计 。 

2. PC 总 线 的 基本 结构 

采用 了 C 总 线 结构 的 单片机 或 IC 器 件 其 内 部 不 似 有 TC 接口 电路 ， 而 且 将 内 部 各 个 单 
元 电路 功能 划分 为 若干 相对 独立 的 模块 ， 通 过 软件 寻 址 实现 片 选 ， 减 少 了 器 件 片 选 线 的 连 
接 。CPU 不 仅 能 通过 指令 将 各 个 功能 单元 电路 挂 起 或 摘 离 总 线 ， 还 可 对 该 单元 的 工作 状况 
进行 检测 ， 从 而 实现 对 硬件 系统 的 既 简单 又 灵活 的 扩展 与 控制 。TC 总 线 接口 电路 结构 如 图 
5-22 所 示 。 


























图 5-22 PC 总 线 接口 电路 结构 








在 硬件 结构 上 ， 任 何 一 个 具有 TC 总 线 接口 的 外 围 器 件 ， 不 论 其 功能 差别 有 多 大 ， 都 具 
有 相同 的 电气 接口 ; 除了 总 线 外 ， 各 器 件 节 点 没有 其 他 电气 连接 ， 甚 至 各 节点 的 电源 都 可 以 
单独 供电 ;在 各 器 件 节点 上 没有 并 行 扩展 时 所 必需 的 片 选 线 ， 咒 件 地 址 给 定 完全 取决 于 器 件 
类 型 与 单元 电路 结构 。 在 软件 上 ， 不 论 何 种 器 件 ， 其 工 C 总 线 的 数据 传送 都 具有 相同 的 操作 
模式 ， 而 且 每 个 絮 件 操作 时 都 与 其 他 絮 件 节点 无 关 。 在 实际 使 用 中 ， 总 线 节 点 上 的 器 件 甚至 
可 在 总 线 工作 状态 下 撤除 或 挂 上 总 线 。 
3. 双向 传输 的 接口 特性 
PC 总 线 在 传送 数据 过 程 中 共有 三 种 类 型 信号 , 它们 分 别 是 :开始 信号 、 结 束 信号 和 应 
号 。 
1) 开始 信号 : SCL 为 高 电 平 时 ，SDA 由 高 电 平 向 低 电 平 跳 变 ， 开 始 传送 数据 。 
2) 结束 信号 : SCL 为 低 电 平时 ，SDA 由 低 电 平 向 高 电 平 跳 变 ， 绪 束 传送 数据 。 
3) 应 答 信号 : 接收 数据 的 IC 在 接收 到 Shit 数据 后 ， 向 发 送 数 据 的 IC 发 出 特定 的 低 电 
平 脉冲 ， 表 示 已 收 到 数据 。CPU 向 受 控 单元 发 出 一 个 信和 号 后 ， 等 待 受 控 单 元 发 出 一 个 应 答 
信号 ，CPU 接收 到 应 答 信 号 后 ， 根 据 实际 情况 做 出 是 否 继续 传递 信号 的 判断 。 若 未 收 到 应 
管 信号 ， 由 判断 为 受 控 单元 出 现 故 障 。 
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目前 有 很 多 半导体 集成 电路 上 都 集成 了 了 TC 接 口 。 HWA PC 接口 的 单片机 有 : CYGNAL 
的 C8051FOXX 系列 、PHILIPSP87LPC7XX 系列 、MICROCHIP 的 PIC16C6XX 系列 等 。 很 多 
外 围 器 件 如 存储 器 、 监 探 芯片 等 也 提供 工 C 接口 。 

4. 数据 的 传送 

PC 规程 运用 主 / 从 双向 通信 。 器 件 发 
送 数据 到 总 线 上 ， 则 定义 为 发 送 器 ， 上 需 件 
接收 数据 ， 则 和 定义 为 接收 器 。 主 器 件 和 从 
髓 件 都 可 以 工作 于 接收 和 发 送 状 态 。 总 线 必 
须 由 主 器 件 (通常 为 微 控制 器 ) 控制 , 主 {d ーー 
any AE RITTER (SCL) ， 控 制 总 线 的 eles 
传输 方向 ， 并 产生 起 始 和 停止 条 件 。SDA Voc 
线 上 的 数据 状态 仅 在 SCL 为 低 电 平 期 间 才 T 
能 改变 ，SCL 为 高 电 平 期 间 ，SDA 状态 的 图 5-23 ”竞赛 机 器 人 的 数据 存储 芯片 
改变 被 用 来 表示 起 始 和 停止 条 件 。 在 竞赛 
机 器 人 中 PIC16F877 作为 了 C 主 控制 器 ，AT24C512 作为 从 控制 器 ， 具 体 电路 如 图 5-23 所 
ZN o 

AT24C512 是 Atmel 公司 生产 的 64KB RITHE PEAY A nF Hie, 内 部 有 S12 页 ， 每 一 
页 为 128 字 节 ， 任 一 单元 的 地 址 为 16 位 ， 地 址 范围 为 0000 ~OFFFFH。 它 采用 8 引 脚 封装 ， 
具有 结构 紧凑 、 存 储 容 量 大 等 特点 ， 可 以 在 2 线 总 线 上 并 接 4 片 芯片 ， 特 别 适 用 于 具有 大 容 
量 数据 存储 要 求 的 数据 采集 系统 ， 因 此 在 测控 系统 中 被 大 量 采 用 。AT24C512 芯片 的 具体 参 
数 请 参考 其 数据 手册 。 
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BOR 竞赛 机 侣 人 的 编程 技术 


机 右 人 的 核心 是 控制 系统 。 机 器 人 的 先进 性 和 功能 的 强 弱 通常 都 直接 与 其 控制 系统 的 性 
能 有 关 。 机 器 人 的 控制 是 一 项 跨 多 学 科 的 综合 性 技术 ,涉及 自动 控制 、 计 算 机 、 传 感 器 、 人 
工 智 能 、 电 子 技术 和 机 械 工程 等 多 学 科 的 内 容 。 前 面 的 音节 已 经 介绍 了 机 器 人 的 结构 ,已 经 
打 好 了 一 个 芝 赛 机 器 人 的 平台 ， 本 章 就 以 吏 赛 机 器 人 走 迷 富 为 例 ， 来 介绍 竞赛 机 器 人 的 软件 
设计 与 程序 实现 。 

莞 赛 机 器 人 平台 的 软件 采用 了 C 语言 编程 ， 采 用 模块 化 编程 思想 ， 易 于 理解 和 移植 。 
竞赛 机 器 人 的 软件 主要 由 初始 化 模块 、 前 进 模块 、 左 转 模块 、 右 转 模 块 、 加 速 模块 、 减 速 模 
块 、 停 车 模块 、 走 定 长 模块 等 组 成 。 通 过 改变 机 器 人 的 软件 ， 可 以 方便 地 修改 机 器 人 的 各 种 
功能 和 人 性能， 实现 各 种 算法 。 


6.1 竞赛 机 器 人 的 控制 























6.1.1 CPU 引 脚 資源 分 本 


PICmicro 系列 芯片 典型 的 70 引 脚 既 能 作为 输入 ， 又 能 作为 输出 ， 在 输出 模式 下 ， 这 些 
引 脚 大 约 可 以 提供 或 者 接受 20mA 的 电流 。 根 据 竞赛 机 器 人 平台 所 要 实现 的 功能 ， 对 单片机 
引 脚 资源 进行 分 配 ，PIC16F877A 单片机 引 脚 排列 如 图 6-1 所 示 。 
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PIC16F877 


图 6-1 PIC16F877A 单片机 的 引 脚 排列 
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1. 竞赛 机 器 人 控制 系统 中 的 输入 信号 

1) 遥控 需 来 的 四 个 按键 A、B、C、D 信号: forward, back, left, hight (开关 量 ) 。 

2) 驱动 板 来 的 四 个 色差 传感器 信号 :line_inl \line_in2 \line_in3 \line_in4( 开 关 量 ) 。 

3) 控制 板 上 的 四 路 红外 传感器 信和 叶 : ray_in1 、ray_in2 、ray_in3 、ray_in4 (模拟 量 )。 

4) 四 路 预 留 的 火焰 传感器 信和 号: ray_in5 、ray_in6 ray_in7, ray_in8 (模拟 量 ) 。 

2. 输出 信号 

1) 四 路 控制 红外 发 射 管 的 信号 : ray_outl 、ray_out2 、ray_out3 、ray_out4 (开关 量 ) 。 

2) 五 个 控制 电动 机 的 信号 : motor_en, motor_la, motor_l1b, motor_2a, motor_2b (Jf 
关 量 )。 

3) 预 留 的 灭火 风扇 驱动 信号 : fan (开关 量 )。 

3. 工 C 总 线 信 号 

SDA ( 串 行 数据 ) 信号 及 SCL ( 串 行 时 钟 ) 信号 。 

4. 程序 下 载 及 在 线 调 试 端口 

PGD PGC, PGM 端口 。 

5. RS232 串口 通信 信号 

TX, RX, 

说 明 : 所 谓 开 关 量 就 是 对 应 0、1 两 种 状态 ， 即 低 电 平和 高 电 平 。 
6.1.2 初始 化 模块 

该 模块 完成 了 单片机 各 端口 定义 、 变 量 定义 及 赋 初 值 、 定 时 器 初始 化 、 中 断 初始 化 、 
A/D 转换 初始 化 、 串 行 口 初始 化 等 内 容 。 各 语句 的 详细 说 明 请 参看 PIC16F877 使 用 手册 。 

1. 系统 初始 化 模块 

系统 初始 化 模块 的 任务 是 完成 单片机 各 端口 的 定义 及 赋 初 值 、 中 断 初始 化 。 该 模块 程序 
如 下 : 


void initial_sys ( ) 


| TRISA =0b00101111, /定义 A 口 (6 位 ) 的 RA4 为 输出 端口 ， 其 他 为 输入 端口 





TRISB =OXFE; // 定 义 B 口 (8 位 ) AY RBO 为 输出 端口 ， 其 他 为 输入 端口 
TRISD = 0X00 : // 定 叉 D 日 (8 位) 的 各 端口 为 输出 

TRISE = 0X07, // 定 叉 E 口 (3 位 ) 的 各 端口 为 输入 

PORTD =0X00; // 赋 D 口 的 初 值 为 0 

PORTE =0X00; // WK E FEA 0 

INTCON =0X00; // 全 局 中 断 禁 止 

GIE =1; // 人 允许 没有 屏蔽 的 中 断 向 CPU 请 求 

PEIE =1; // 人 允许 各 外 设 中 断 


| 
2. 定时 器 Timer 0 初始 化 模块 
定时 器 Timer0 初始 化 模块 的 任务 是 完成 与 定时 器 Timer0 相关 的 设置 。 该 模块 程序 如 下 : 
void initial TO ( ) | 
INTCON =0x00; // 全 局 中 断 禁 止 


| 
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GIE =1; // 人 允许 没有 屏蔽 的 中 断 向 CPU 请 求 
TMRO =OX7f; // 置 定时 器 初 值 

TOIE =1; //TimerO 溢出 中 断 允 许 

TOIF =0; // Timer0 溢出 中 断 标 志 位 清 零 
TOCS =0; // 使 用 内 部 指令 周期 时 钟 

PSA =0; // 预 分 频 器 分 配给 Timer0 模块 
PSO =1; 

PSI =1 

PS2 =1; //PSO: PS2 =111 ， 预 分 频 器 比 选 择 


3. A/D 转换 初始 化 模块 
A/D 转换 初始 化 模块 的 任务 是 把 连续 变化 的 模拟 量 转换 为 离散 的 数字 量 。 该 模块 程序 


如 下 : 


void 


| 
6.1.3 








adinitial ( ) | 

ADCS1 =1; 

ADCS0 =0; /ADCS1: ADCS0 =00， 时 钟 选择 位 /32， 即 7 不 小 于 1. Ops 
CHS2 =0; 


CHS1 =0; 
CHS0 =0; //CHS2: CHSO =000, A/D 模拟 通道 选择 位 ， 选 择 了 通道 0 
ADCON1 =0X00; // 转 换 结 果 左 移 ，ADRESL 低 6 位 为 0，8 个 通道 A/D 
PIE1 =0X70: //A/D 转换 中 断 使 能 ， 其 他 外 设 中 断 禁 止 
PIE2 = 0X00; //CCP2, SSP, EEPROM 写 操作 中 断 禁 止 

运动 模块 


运动 模块 又 包括 如 下 子 模块 : 

1. 前 进 模块 

前 进 模块 的 任务 是 控制 范 赛 机 器 人 沿 着 直线 前 进 。 从 竞赛 机 器 人 的 原理 图 5-5 可 见 ， 单 
片 机 驱动 直流 电动 机 的 信号 为 分 别 为 RBO0、RD4、RD5 、RD6 、RD7。 前 进 模块 由 motor_for- 
ward ( ) 函数 完成 。 


void 


| 


| 














motor_forward ( ) 


EN_MOTOR =1; // 使 能 L298 

RD4 =0; // 驱 动 左 轮 正 转 ( 向 前 转 ) 
RDS =1; 

RD6 = 1; // 驱 动 右 轮 正 转 〈 回 前 转 ) 
RD7 =0; 


2. 原 地 右 转 模块 
右 转 模块 的 任务 是 控制 竞赛 机 器 人 通过 左轮 正 转 或 右 轮 反 转 来 实现 原 地 向 右 转 弯 。 从 竞 
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赛 机 器 人 的 原理 图 CULE 5-5) 可 见 , 单片机 了 驱动 直流 电动 机 的 信号 分 别 为 RBO 、RD4 、 
RD5 、RD6 、RD7。 右 转 模 块 由 motor_right ( ) 函数 完成 。 
void motor_right ( ) 





| EN_MOTOR =1; // 使 能 L298 
RD4 =0; // 驱 动 左 轮 正 转 (向 前 转 ) 
RDS =1; 
RD6 =0; // 驱 动 右 轮 反 转 (向 后 转 ) 
RD7 =1; 


| 

3. 原 地 左 转 模块 

左 转 模 块 的 任务 是 控制 竞赛 机 器 人 通过 右 轮 正 转 或 左轮 反 转 来 实现 原 地 向 左 转弯 。 从 竞 
赛 机 器 人 的 原理 图 ( 见 图 5-5) 可 見 , 单片机 驱动 直流 电动 机 的 信号 分 别 为 RBO 、RD4 、 
RD5 、RD6 、RD7 。 左 转 模 块 由 motor_left ( ) 函数 完成 。 

void motor_left ( ) 














| EN_MOTOR =1; // 使 能 L298 
RD4 =1; // 驱 动 左 轮 反 转 ( 向 后 转 ) 
RDS =0; 
RD6 =1; // SRD AG HE IER ( 向 前 特 ) 
RD7 =0; 


| 

4. 左 转 90° 模 块 

左 转 90?" 模 块 的 功能 是 控制 竞赛 机 器 人 按 逆 时 针 方向 原 地 左 转 90*。 从 驱动 板结 构图 
( 见 图 42) 可 以 看 出 ,左轮 反 转 (向 后 转 )， 同 时 右 轮 正 转 (向 前 转 ) 一 定 的 时 间 turn 
time_set， 就 可 以 实现 竞赛 机 器 人 左 转 90°, turn_time_set =30, 大约 为 0.2s。 左 转 90° 模 块 
由 函数 void motor_90left ( ) 完成 。 

void motor_90left ( ) 





| time =0; 
EN_MOTOR =1; // 使 能 L298 
RD4 =1; // 驱 动 左轮 反 转 (向 后 转 ) 
RDS =0; 
RD6 = 1; // 驱 动 右 轮 正 转 〈 回 前 转 ) 
RD7 =0; 


while (time! =turn_time_set); // 等 待 
motor_stop () ; 
time =0; // 时 间 清 零 
stime =0; 
| 
5. 右 转 90° 模 块 
右 转 90?" 模 块 的 功能 是 控制 竞赛 机 器 人 按 逆 时 针 方向 原 地 右 转 90*。 从 驱动 板结 构图 
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(ULAR 4-2) 可 以 看 出 ,左轮 正 转 (向 前 转 )， 同 时 右 轮 反 转 (向 后 转 ) 一 定 的 时 间 turn 
time_set， 就 可 以 实现 竞赛 机 器 人 右 转 90°。turn_time_set =30, 大约 为 0.2s。 右 转 90° 模 块 
由 函数 void motor_90right ( ) 完成 。 

6. 行走 模块 

在 竞赛 机 器 人 沿 跑 道中 线 前 进 时 ， 需 要 不 断根 据 传感器 信和 号 调整 行走 方向 ， 使 得 竞赛 机 
器 人 不 会 撞 到 墙 上 ， 这 时 的 左 转 右 转 只 是 在 不 断 地 调整 ， 左 转 功能 模块 具体 由 左轮 停止 转 
动 、 右 轮 继续 向 前 运动 来 实现 ， 即 通过 (RDS =0; RD6 =1;) 完成 ， 同 理 右 转 模块 具体 由 
函数 (RDS =1; RD6 =0; ) 完成 。 在 前 进 过 程 中 ， 会 遇 到 四 种 情况 : 

1) 左 侧 有 墙壁 ， 右 侧 无 墙壁 ; 

2) 左 侧 无 墙壁 ， 右 侧 有 墙壁 ; 

3) 左 侧 和 右 侧 都 有 墙壁 ; 

4) 左 侧 和 右 侧 都 无 墙壁 。 

因此 需要 根据 不 同情 况 来 设计 行走 过 程 中 的 方向 调整 方案 。 当 只 有 一 侧 有 墙壁 时 ， 需 要 
根据 这 一 侧 墙壁 的 传感器 反馈 信号 进行 纠偏 ; 当 两 侧 都 有 墙壁 时 ， 根 据 两 侧 的 传感器 纠偏 ; 
当 两 侧 都 没有 墙壁 时 ， 继 续 前 进 。 沿 左 侧 墙壁 纠偏 由 函数 alongleft ( ) 具体 实现 ， 沿 右 侧 墙 
壁 纠 偏 由 函数 alongright ( ) 具体 实现 ， 沿 两 侧 墙 壁 纠偏 由 函数 alongbothside ( ) 具体 实现 。 
当 两 侧 传 感 器 探测 距离 大 于 7cm 时 ， 认 为 该 侧 没 有 墙壁 。 

/ 右 侧 无 墙壁 ， 依 据 左 侧 传感器 沿 着 左 侧 墙壁 行走 

void alongleft( ) | 

if( (adresult_an[3 ] < =yScm_left ) &&(adresult_an[3] > =Y7cm_left) ) | RDS =0;RD6 = 
1;| 

// 左 侧 传 感 器 与 墙壁 的 距离 大 于 $cm 小 于 7cm 时 ,向 左 转 

else if( adresult_an[ 3 | > =y2cm_left) {RDS =1;RD6 =0; } 

// 左 侧 传感器 与 墙壁 的 距离 小 于 2cm 时 ,向 右 转 

else | RDS =1; RD6=1;} 

// 继 续 前 进 

| 





























// 左 侧 无 墙壁 ,依据 右 侧 传感器 党 着 右 侧 墙壁 行走 

void alongright( ) | 

if( (adresult_an[0] < = ySem_right) && (adresult_an[0] > = y7em_right)) | RDS =1; 
RD6 =0:| 

// 右 侧 传 感 器 与 墙壁 的 距离 大 于 5$cm 小 于 7cm 时 ,向 右 转 

else if( adresult_an[0] > =y2cm_right) {RDS =0;RD6 =1;} 

// 右 侧 传感器 与 墙壁 的 距离 小 于 2cm 时 ,向 左 转 

else | RDS =1; RD6=1;} 

// 继 续 前 进 

| 
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// 两 侧 都 有 墙壁 , 沿 两 侧 墙 中 间 走 

void alongbothside( ) | 

if(adresult_an[0] > =y3cm_right) {RDS =0:RD6 =1:| // 右 侧 距 离 小 于 3cm ,向 左 转 
else if(adresult_an[3] > =y3cm_left) {RD5=1;RD6=0;} ”// 左 侧 距 离 小 于 3cm ,向 右 转 
else ! RDS =1; RD6 =1;} // 继 续 前 进 

| 


在 函数 中 左轮 控制 电压 为 PWM 波 ， vy 
波形 如 图 6-2 所 示 。 可 见 加 在 左轮 电动 Pe Di i : 
机 的 平均 电压 减 小 ， 从 而 减 小 了 其 速度 ， 
oe eee "| ' 
速 前 进 ， 从 而 实现 了 左 转 。 
7. 停车 模块 到 


停车 模块 的 功能 是 控制 竞赛 机 器 人 
准确 停车 ， 这 里 采用 了 能 耗 制 动 ， 将 左 Bo ENM oy 
轮 和 右 轮 驱动 电压 置 零 ， 则 由 反 电动 势 产 生 的 制 动 电流 由 放电 回路 释放 ， 如 图 6-3 所 示 ， 从 
而 使 竞赛 机 器 人 尽快 停止 运动 ， 具 体 由 函数 motor_stop ( ) 完成 。 


motor stop ( ) 

















| EN_MOTOR =0; //# IŁ L298 
RD4 =0; // Fe REAL SOLE BAS 
RDS =0; 
RD6 =0; // 右 轮 电动 机 电压 为 零 
RD7 =0; 



































图 63 驱动 电动 机 的 能 耗 制 动 的 放电 回路 

8. 走 定 长 模块 

竞赛 机 器 人 经 常 需要 走 固定 长 度 的 距离 ， 如 半 个 跑道 宽度 的 距离 ， 具 体 由 motor_half- 
grid ( ) 完成 。 NN RI SG 
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void motor_halfgrid(_ ) 
| halfgrid_time =0; 
EN_MOTOR =1; // 使 能 L298 
RD4 =0: 
RD3 = jiupian_pwm; 
RD6 =1; 
RD7 =0; 
while (halfgrid_time! = halfgrid_time_set) ; 
motor_stop( ) ; 
flag = STOP; 
| 


6.1.4 A-D 转换 模块 
A-D 转换 模块 由 函数 ad( ) 完 成 。A-D 转换 的 程序 框图 如 图 64 所 示 。 

















图 64 A-D 转换 的 程序 框图 


void ad4( ) 


| unsigned char i; 
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for(i =0; i<4; i+ +){ 


switch (i) // 置 A-D 转换 通道 号 ， 人 


{case0: {CHSI =0; CHSO =0; RAY_OUT1 = 1;}; break; 
casel : {CHSI =0; CHSO =1; RAY_OUT2 = 1;}; break; 
case2: {CHSI =1; CHSO =0; RAY_OUT3 = 1;}; break; 
case3: {CHSI =1, CHSO =1; RAY_OUT4 = 1;}; break; 
| 
delay (1000) ; 
ADON =1; // RYE A-D 转换 
ADGO =1; // 启 动 A-D 转换 
while(! ADIF); // 等 待 转 换 完毕 
ADIF =0: // 清 除 中 断 标 志 


adresult_an|i|. adre[ 0] =ADRESL; // 读 取 并 存储 A-D 转换 结果 
adresult_an| i]. adre[ 1 | =ADRESH : 
delay (250) ; 
switch (i) // 关 闭 红 外 发 射 管 
{case 0; RAY_OUT1 = 0; break; 

case 1; RAY_OUT2 = 0; break; 

case 2: RAY_OUT3 = 0; break; 

case 3: RAY_OUT4 = 0; break; 

| 


6.2 迷宫 智能 算法 的 实现 


迷宫 智能 算法 模块 的 主要 功能 是 : 

1) 优化 设置 模块 (优化 设置 苑 赛 机 器 人 最 佳 加 减速 度 ， 控 制 策略 ) ; 
2) 解决 迷宫 问题 算法 的 实现 ; 

3) 经 历 路 径 的 记忆 

4) 竞赛 机 口 人 速度 的 控制 (加 速 、 减 速 的 平滑 转弯 等 ); 

5) 迷宫 策略 的 优化 。 


6.2.1 沿 跑道 中 线 前 进 的 判断 程序 


由 于 迷宫 的 跑道 较 窑 ， 曲 折 变 化 ， 机 咒 人 经 常 要 转 90"、180" 等 ， 这 就 需要 兖 赛 机 器 人 
ON A 
富 场地 中 每 个 小 格 的 标准 长 度 是 180mm , | 组 装 迷宫 场地 ， 这 
A ee Zi 20mm, 故 迷 
宫 的 跑道 宽度 是 172mm, NE Bi E SEE JLP o 
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赛 机 器 人 在 跑道 中 线 时 ， 左 右边 距离 各 是 36mm, 

从 图 5-14 所 示 的 传感器 输出 电压 VV 与 检测 距离 x 之 间 的 关系 曲线 中 可 以 看 出 ， 当 检测 
距离 x*<3cm 时 ,检测 电压 Va >2.4V， 说 明 苋 赛 机 器 人 偏离 中 线 ， 疝 左 偏 了 。 当 检测 距离 x 
>4cm 时 ，V <1.73SV， 说 明 竞 赛 机 器 人 偏离 中 线 ， 向 右 偏 了 。 根 据 曲线 的 对 应 关系 ， 可 以 
实现 竞赛 机 器 人 治 着 跑道 中 线 前 进 。 

首先 实现 溜 边 走 的 程序 。 竞 赛 机 器 人 溜 边 前 进 的 示意 图 如 图 6-5 所 示 。 当 竞赛 机 器 人 左 
侧 的 传感器 测 得 距离 L <3cm 时 ， 竞 赛 机 器 人 右 毛 ， 当 左 侧 传感器 测 得 左 侧 距 离 L, >4cm 
时 ,竞赛 机 器 人 左 拐 。 如 图 6-5 所 示 ， 路 径 $ 是 竞赛 机 器 人 的 实际 前 进 路 线 ， 整 体 地 看 ， 相 
当 于 竞赛 机 器 人 沿 着 跑道 中 线 M 前 进 。 溜 边 前 进 的 程序 框图 如 图 6-6 所 示 。 汐 辺 走 的 功能 
liubian( ) 函数 完成 。 

迷宫 隔 栅 





























图 6-5 竞赛 机 器 人 溜 边 前 进 的 示意 图 





启动 


侧 距 离 L1<3cm 吗 ? x 
Y 
左 侧 距离 L>4cm 吗 ? 


『 


A 6-6 溜 边 前 进 的 程序 框图 






















liubian( ) | 
if(adresult_an[ 0]. y > =y24) turntoright( ) ; ///\\F 3cm, AFH 
else if( adresult_an[ 0]. y < =yl7) turntoleft( ); //K-F4em, Æ 
else turntoforward( ) ; // 前 进 


if(adresult_an[ 1 ]. y > =y24) motor_stop( ); // 前 方 距 离 小 于 3cm( 有 隔 栅 )， 停 
| 


6.2.2 无 记忆 功能 迷宫 算法 的 编程 实现 


无 记忆 功能 的 迷宫 算法 的 程序 框图 如 图 6-7 所 示 ， 在 迷宫 中 自由 行走 的 程序 由 函数 pan- 
duan( ) 完 成 。 
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X 
6 ERSO 
左 侧 有 隔 栅 吗 ? 





x 
溜 左 边 前 进 








渔 左边 前 进 


图 6-7 无 记忆 功能 的 迷宫 算法 的 程序 框图 











// 直 走动 作 


void motor_along( ) | 


| 


6.2.3 ”有 记忆 功能 的 迷宫 算法 分 析 
欧 完 机 右 人 有 了 记忆 功能 ， 才 能 表现 出 智能 。 
1. 迷宮 的 状況 
设 在 迷宫 中 的 竞赛 机 器 人 如 图 6-8 所 示 ， 竞 赛 机 器 人 有 具 


EN_MOTOR =1; // 使 能 L298 
RD4 =0; 
RD7 =0; 
if( (adresult_an[0 ] > = y7cm_right) &&(adresult_an[ 3] > =y7cm_left) ) 
| 
alongbothside( ) ; // 两 侧 都 有 墙壁 ， 双 边 纠 偏 
| 
else if( (adresult_an|0 | < =y7em_right) && ( adresult_an[3 ] > = y7cm_left) ) 
| 
alongleft( ) ; // 只 有 左 侧 有 墙壁 ， 左 单 边 纠偏 





| 
else if( (adresult_an|0 | > =y7em_right) &&(adresult_an[ 3 ] < = y7cm_left) ) 
| 

alongright( ) ; // 只 有 右 侧 有 墙壁 ， 右 单 边 纠偏 








| 
else} RDS =1; RD6 =1;| // 继 续 前 进 





有 三 个 方向 的 传感器 : 前 方 传感器 下 、 左 方 传感器 L、 右 方 传 





感 器 R。 如 果 前 方 有 隔 栅 ， 则 传感器 来 的 信号 为 "1" ， 无 隔 机 anon 
则 为 “0”。 竞 赛 机 器 人 在 迷宫 中 运动 时 ， 三 个 传感器 了 、L、R ASS TERTIA 
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会 传 来 迷宫 的 8 种 状况 ， 即 111 110, 101, 100, 011, 010, 001, 000, I 6-9 所 示 。 即 
SEW] 111、 右 转弯 110 、 左 转弯 101、 直 丁字 路 口 100、 直 路 011、 右 丁字 路 口 010、 左 丁字 
路 口 001 、 十 字 路 口 000。 


EF 加 
el 回 56] で に 回 ler 32/38 


101 011 001 000 
图 6-9 迷宮 的 8 种 状况 

2. 记忆 迷 官 的 状态 寄存 器 

设 可 位 操作 的 路 况 寄存 器 road_flag 用 来 记忆 迷宫 的 路 况 ， 每 遇 到 变化 的 分 又 的 路 况 ， 
置 road_flag.0=1 或 0, 日 左 移 一 位 ， 把 路 况 保存 起 来 。“1” 表 示 可 前 进 ,“0” 表 示 可 右 转 
(对 于 十 字 路 口 ， 右 转 优先 ) ， 如 图 6-10 所 示 。 

Pea a dead_flag FRR id 1235 RHEE ARI F— “PS FCA [A], Ft dead_flag. 0 
=1， 且 左 移 一 位 。 

| turn_flag 用 来 记忆 竞赛 机 器 人 的 向 左 转 或 向 右 转 的 操作 状态 ， 如 图 6-11 
所 示 。 

可 前 进 左 转 




















turn_f lag turn_f lag 0 


road flag road flag.0 





图 6-10 “可 位 操作 的 路 况 寄 存 器 road_flag E a 


3. 迷宫 问题 的 分 析 

一 般 的 迷宫 有 上 面 的 8 种 状况 ， 当 竞赛 机 器 人 遇 到 这 8 种 状况 时 ， 做 出 正确 的 选择 才能 
走出 迷宫 。 下 面具 体 来 研究 竞赛 机 器 人 遇 到 这 8 种 状况 时 应 采取 的 措施 。 

(1) 死胡同 111 状況 SEED Lat AGS BN CHAIR] 111 状况 时 ， 应 采取 的 处 理 方法 是 : 原 
地 180" 调 头 ， 同 时 置 死胡同 标志 ， 如 图 6-12 所 示 , H state_111( ) 函数 实现 。 

(2) 右 转弯 110 状况 ” 当 葛 赛 机 器 人 遇 到 右 转弯 110 状况 时 ， 应 采取 的 处 理 方法 是 : 原 
地 右 转 90° 前 进 ， 如 图 6-13 所 示 , 由 state_110( ) 函数 实现 。 


可 - 同 eE 


111 011 110 011 





图 6-12 死胡同 111 状况 图 6-13 APB 110 状况 
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(3) ÆRES 101 状况 ” 当 竞 赛 机 器 人 遇 到 左 转弯 101 状况 时 ， 应 采取 的 处 理 方法 是 : 原 
地 左 转 90° 前 进 ， 如 图 6-14 所 示 , 由 state_101( ) 函数 实现 。 

(4) 直路 011 状态 ” 当 竞 赛 机 器 人 处 于 直路 011 状态 时 ， 应 采取 的 处 理 方法 是 : 继续 保 
持 前 进 ， 由 state_011( ) 函数 实现 。 

(5) 十 字 路 口 000 状态 “” 当 竞赛 机 器 人 遇 到 十 字 路 口 000 状态 时 ， 应 采取 的 处 理 方法 
Fe: 向 右 转 90° 前 进 ， 如 图 6-15 所 示 , H state_000( ) 函数 实现 。 


El == E T os E 
3 Ea i i 








图 6-14” 左 转弯 101 状況 图 6-15 ”十字 路 口 000 状况 





(6) 直 丁 字 路 口 100 状态 MRVA RAA S FO 100 状态 时 ， 如 图 6-16 所 示 。 
应 采取 的 人 处理 方法 的 程序 框图 如 图 6-17 所 示 ， 由 state_100( ) 函数 实现 。 


5 / O 








100 100 





图 6-16 BIAT FA 100 状况 











记 路 况 ， 记 转向 清 死胡同 标志 清 死 胡同 标志 
左 移 且 road flag.0=0 road flag>>1, 清 路 況 road flag>>1, 清 路 況 


左 移 是 turn flag.0=0 turn flag>>1, 清 转向 tum flag>>1, 清 转向 





图 6-17 SAAT FO 100 状况 时 的 程序 框图 

















(7) 右 丁 字 路 口 010 状态 当 竞 赛 机 器 人 遇 到 右 丁 字 路 口 010 状态 时 ， 如 图 6-18 所 示 。 
应 采取 的 人 处理 方法 的 程序 框图 如 图 6-19 所 示 ， 由 state_010( ) 函数 实现 。 
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图 加 
a a 
a) b) 


图 6-18 丁字 路 口 状况 


刚才 是 前 进 吗 ? 


road flag.0=1? 





















记 路 况 ， 记 转向 ae 清 死胡同 标志 
左 移 是 road flag.0=1 清 死胡同 ， 记 转向 road_flag>>1, 


左 移 且 tum flag.0=0 左 移 且 turn flag.=0 清 路 況 








图 6-19 BIAT FO 010 状况 时 的 程序 框图 


(8) 左 丁 字 路 口 001 状态 当 竞 赛 机 器 人 遇 到 左 丁 字 路 口 001 状态 时 ， 如 图 6-18b 所 
示 。 应 采取 的 处 理 方法 的 程序 框图 如 图 6-20 所 示 ， 由 state_001( ) 函数 实现 。 


【刚才 是 前 进 吗 ? 


road_flag.0=1? 











清 死 胡同 ， 记 转向 
左 移 且 turn flag=1 


TRU 
左 移 且 road_ flag.0=1 

















图 620” 遇 到 左 丁 字 路 口 001 状况 时 的 程序 框图 
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4. 迷宫 问题 的 解决 

竞赛 机 器 人 在 遇 到 每 种 分 叉 口 状况 时 ， 记 忆 路 况 ， 转 向 。 当 遇 到 死 衣 同时 返回 ， 当 返回 
时 遇 到 刚才 的 分 又 口 时 ， 根 据 上 次 的 转向 ， 决 定 当 前 的 运动 ， 或 前 进 或 左 转 或 右 转 。 其 程序 
框图 如 图 6-21 所 示 。 
















读 传感器 的 信号 






判断 进入 对 应 状态 


Y 


~ em トー トー co | 














TN 





6-21 具有 记忆 功能 的 迷宫 程序 框图 








6.3 ”上 位 机 软件 


上 位 计算 机 一 般 是 指 以 个 人 计算 机 为 硬件 的 基于 高 级 语言 进行 软件 开发 的 计算 机 系统 。 
它 主要 完成 复杂 功能 的 软件 设计 与 程序 实现 。 上 位 机 主要 目的 是 为 操作 者 提供 一 个 友好 的 控 
制 界面 ， 方 便 操作 者 的 控制 。 下 位 计算 机 一 般 是 指 单 片 计算 机 ， 主 要 完成 实时 性 要 求 较 高 的 
控制 与 计算 功能 。 下 位 机 通过 各 种 通信 手段 来 与 上 位 机 通信 ， 通 信 得 到 的 数据 ， 作 控制 还 是 
作 数 据 用 ， 这 是 依据 程序 的 设计 而 定 的 ， 下 位 机 主要 处 理 一 些 直 接 的 控制 任务 ， 如 电动 机 的 
控制 等 ， 而 上 位 机 则 主要 从 宏观 上 考虑 控制 的 策略 ( 比赛 的 策略 ) ， 分 析 场 地 情况 。 由 于 有 
了 这 样 的 结构 ， 即 骨架 ,我 们 就 可 以 在 这 样 的 骨架 上 添加 肌肉 ， 让 我 们 的 机 器 人 控制 系 
统 更 加 健壮 。 经 过 努力 ， 我 们 初步 地 实现 了 这 个 控制 结构 ， 从 设计 到 实施 ， 都 表现 出 了 
这 种 竞赛 机 器 人 的 控制 结构 的 优越 性 。 控 制 结构 的 好 坏 直接 影响 到 控制 的 效果 和 控制 的 
目的 。 

这 里 ， 上 位 机 主要 功能 是 : 利用 上 位 机 软件 界面 ， 设 置 与 实际 迷宫 一 致 的 模拟 迷宫 ， 人 
为 给 出 具体 路 径 ， 经 无 线 下 载 到 竞赛 机 器 人 中 ， 葛 赛 机 器 人 就 按照 上 位 机 的 设置 路 径 精 确 运 
行 。 上 位 机 软件 界面 如 图 6-22 所 示 。 上 位 机 主要 用 来 完成 如 下 功能 : 

1) 解决 迷宫 问题 算法 的 实现 ; 

2) 经 历 路 径 的 记忆 ; 

3) 鞠 赛 机 恬 人 速度 的 控制 (加 速 、 减 速 的 平滑 ,转弯 等 ) ; 

4) 迷宫 策略 的 优化 。 
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图 6-22 上 位 机 软件 界面 
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第 7 曹 SEBEL a A MY ie oN Pe hl FF id 


7.1 PID 控制 算法 


7.1.1 PID 控制 简介 

在 工程 实际 中 ， 应 用 最 为 广泛 的 调节 器 控制 规则 就 是 比例 (Proportion), 、 积 分 (Inte- 
gral) 、 微 分 (Derivative) 控制 ， 简 称 PID 控制 。PID Feil alates A 70 余年 ， 它 以 结 
构 简 单 、 稳 定性 好 、 工 作 可 靠 、 调 整 方便 而 成 为 工业 控制 主要 技术 之 一 。PID 控制 技术 主要 
应 用 于 系统 控制 器 结构 和 参数 不 能 通过 理论 计算 ， 必 须 依 靠 经 验 和 现场 调试 来 确定 的 情况 。 
即 当 不 完全 了 解 一 个 系统 的 控制 过 程 和 被 控 对 象 的 有 效 参 数 时 ， 适 用 PID 控制 技术 。PID 控 
制 实际 中 也 分 PI 控制 和 PD 控制 。PID 控制 器 就 是 利用 比例 、 积 分 、 微 分 三 种 控制 来 尽量 减 
小 被 控 对 象 产 生 的 系统 误 ， 以 及 加 强 系 统 稳定 性 与 抗 干扰 能 力 。 图 7-1 所 示 为 PID 控制 系统 


原理 图 。 
rt) 4 + + ud c(t) 
=| = OS 行 | % Æ me 


图 7-1 PID 控制 系统 原理 图 


























下 面 将 各 种 常用 控制 规律 的 控制 特点 进行 简单 的 总 结 。 

(1) 比例 控制 规律 (P) 。 采 用 比例 控制 规律 能 较 快 地 克服 扰动 的 影响 ， 比 例 控制 的 主 
要 作用 是 减 小 偏差 ， 比 例 作 用 越 大 ， 调 节 速 度 越 快 。 但 比例 调节 不 能 很 好 地 稳定 在 一 个 理想 
的 数值 ， 会 有 余 差 出 现 。 因 此 比例 控制 仅 适用 于 控制 要 求 不 高 、 负 葆 变化 不 大 、 控 制 洲 后 对 
被 控 对 象 影响 不 大 ， 或 者 被 控 参 数 允 许 在 一 定 范 围 内 有 余 差 的 场合 。 

(2) 比例 积分 控制 规律 (PI) 。 在 工程 中 ， 比 例 积分 控制 规律 是 应 用 最 广泛 的 一 种 控制 
规律 。 积 分 项 是 对 控制 时 间 的 积分 ， 随 着 时 间 的 增加 ， 积 分 项 也 会 随 之 增 大 ， 从 而 推动 控制 
器 的 输出 增 大 ,使 稳 态 误差 进一步 减 小 ， 直 到 等 于 零 。 积 分 项 的 引入 可 以 帮助 比例 控制 消除 
系统 余 差 。 

(3) 比例 微分 控制 规律 (PD) 。 微 分 调节 具有 预见 性 ， 系 统 可 以 预见 偏差 的 变化 趋势 并 
产生 超前 控制 作用 ， 在 偏差 形成 之 前 将 其 消除 。 对 于 具有 清 后 的 控制 通道 ， 引 入 适当 的 微分 
调节 参与 控制 ， 可 以 有 效 减 少 系统 超 调 量 与 调节 时 间 ， 对 于 提高 系统 的 动态 性 能 指标 有 着 显 
车 效果 。 因 此 ， 对 于 控制 通道 的 时 间 常 数 或 时 间 池 后 较 大 的 场合 ， 为 了 提高 系统 的 稳定 性 ， 
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减 小 动态 偏差 等 可 选用 比例 微分 控制 规律 。 与 此 同时 ， 微 分 作用 也 会 放大 外 界 的 干扰 ， 使 得 
系统 抗 干 扰 能 力 下 降 ， 故 不 能 施加 过 大 的 微分 作用 。 

(4) 例 积分 微分 控制 规律 (PID)。PID 控制 规律 是 一 种 较 理想 的 控制 规律 ， 它 在 比例 控 
制 的 基础 上 引入 积分 ， 可 以 消除 余 差 ， 再 加 入 微分 作用 ， 又 能 提高 系统 的 稳定 性 。 它 适用 于 
控制 通道 时 间 和 常数 或 时 间 江 后 较 大 、 控 制 要 求 较 高 的 场合 。 

竞赛 机 器 人 的 结构 与 各 个 模块 的 工作 参数 往往 会 受到 场地 、 灯 光 、 环 境 等 因素 的 影响 ， 
导致 控制 系统 无 法 构造 精准 的 数学 模型 ， 所 以 机 器 人 的 控制 参数 及 控制 器 结构 通常 需要 开发 
人 员 在 现场 依靠 经 验 进行 调试 ， 因 此 PID 控制 技术 的 灵活 应 用 成 为 机 器 人 竞赛 选手 制胜 的 关 
键 。 
7.1.2 PID 控制 算法 分 类 

1. 模拟 PID 调节 器 

PID 调节 器 是 一 种 线性 调节 器 ， 它 将 给 定 值 "( 切 与 实际 输出 值 (0) 偏差 的 比例 (P) 、 积 
分 (I) 、 微 分 (D ) 通 过 线性 组 合 构成 控制 量 ， 对 被 控 对 象 进行 控制 。PID 调节 器 的 微分 方程 
如 下 : 














w(t) = Kafee +2 fears 7, 2 (7-1) 
e(t) =r) 一 6( が ) (7-2) 
PID 调节 器 的 传递 函数 对 应 如 下 : 
s 1 
G(s) =F Rll + Tos] (7-3) 





模拟 PID 控制 系统 框图 如 图 7-2 所 示 。 


t 
の i e(t) pID 控 制 器 u(t) 被 控 对 象 cD 


图 72 模拟 PID 控制 系统 框图 














2. 数字 PID 调节 器 
为 了 便于 计算 机 实现 PID 控制 算式 ， 必 须 把 连续 函数 微分 方程 改写 成 为 离散 的 差分 方 
程 ， 模 拟 PID 控制 规律 的 离散 化 见 表 7-1。 
表 7-1 模拟 PID 算 子 离散 化 对 照 表 























模拟 形式 离散 化 形式 
e(t) =r(t) -c(i) e(n) =r(n) 一 c( か ) 
de(t) e(n) -e(n-1) 
dt T 
fea Yer = TY e(i) 
0 ヵ =0 7=0 





根据 式 (7-1) 结 合 表 7-1 可 以 得 出 差分 方程 。 
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n Ty 
u(n) = Kyle(n) + BD el) + elem) -eln = 1) (7-4) 


NP, u(n) ER n 时刻 的 系统 离散 控制 量 ， 如 果 控 制 周 期 7 了 比 被 控 对 象 时 间 常 数 Ks 小 ， 则 
该 离散 控制 与 连续 控制 十 分 接近 。 由 于 在 模拟 PID 调节 器 控制 过 程 中 很 难 实现 理想 微分 
や 所 以 通过 计算 机 对 差分 方程 式 (7-4) 进 行 近似 计算 ， 得 到 控制 参数 的 方法 称 为 理想 微 
分 PID 数字 控制 器 。 

在 计算 机 控制 系统 中 ， 数 字 PID 控制 算法 又 分 为 位 置式 PID 和 増 量 式 PID。 

(1) 位 置 型 PID。 模 拟 PID 调节 器 的 调节 动作 是 连续 的 ， 任 一 瞬间 的 输出 控制 量 w 都 对 
应 一 个 被 控 对 象 的 位 置 状态 ， 由 式 (74) 可知 数 字 PID 调节 絮 每 一 个 采样 时 刻 的 输出 控制 量 
u(n) 也 与 被 控 对 象 的 位 置 对 应 ， 夏 称 式 (74) 为 位 置 型 PID 算式 (位 置式 PID ) 。 由 于 计算 机 
在 实现 位 置 型 算式 的 过 程 中 需要 不 断 累 加 偏差 e(j) ， 不 仅 占 用 了 大 量 存储 单元 ， 而 且 编程 复 
杂 ， 因 此 需要 对 原 算式 进行 改进 。 

(2) 増量 型 PID。 根 据 式 (74) 不 难 写 出 第 (n -1) 时 刻 的 控制 量 x(z -1)， 即 


























ヵ カー1 ie 
u(n-1) = K,je(n-1) + Dy) + pele -1) -e(n-2)]} (7-5) 
TL ( 7-4) WRAL (7-5) 后 得 到 ヵ 时刻 控制 量 的 增 量 uw(n) 
Ty 
Au(n) =K,{e(n) -e(n-1) Zela) Egle) -2e(n-1)+e(n-2)]} (7-6) 


由 于 式 (7-6) 中 的 Au(n) 对 应 于 第 n 时 刻 被 控 对 象 位 置 的 增 量 ， 故 称 此 式 为 增 量 算式 。 
因 此 , n 时 刻 的 实际 控制 量 为 





u(n)=u(n-1)+Au(n) (7-7) 

式 中 , x( ヵ -1) 娘 第 ( ヵ -1) 时 刻 的 控制 量 。 

综 上 所 述 ， 计 算 Au(n) 和 w(n) 要 用 到 第 (n -1)，(n -2) 
刻 的 訪 史 数 据 e(rn-1), e( ヵ -2) 和 z( ヵ ー1) , X3 个 历史 数据 也 
已 在 前 时 刻 存 于 内 存储 器 。 通 党 采用 平移 法 保存 这 些 历史 数据 。 
比如 ， 计 算 完 &(z) 后 ， 首 先 将 e(z -1) FA e( ヵ -2) 単 元 , 然 后 
feln) FFA e(n -1) 単 元 , 以 及 把 u(n) FA u(n -1) Foc, 如 
图 7-3 所 示 。 这 样 就 为 下 时 刻 计算 机 做 好 准备 。 

由 此 可 见 ， 采 用 增 量 型 算式 当 存 在 计算 误差 或 精度 不 足 时 ， 
对 控制 量 计算 的 影响 很 小 ; 另外， 增 量 式 易于 实现 PID 调节 器 手 M3 MERR 
动 到 自动 的 无 冲击 切换 。 位 置 型 PID 与 增 量 型 PID 控制 算法 的 流 ae 
程 如 图 7-4 所 示 。 

3. 不 完全 微分 PID 

将 微分 环节 引入 智能 车 的 方向 和 速度 控制 ， 能 明显 改善 系统 的 动态 性 能 ， 但 同时 也 会 使 
系统 对 于 外 界 干扰 及 信和 号 突变 特别 敏感 ， 影 响 系 统 的 稳定 性 。 为 了 克服 上 述 缺 点 ， 本 文 在 
PID 算法 中 加 入 了 一 阶 惯性 环节 。 不 完全 微分 PID 算法 结构 如 图 7-5 所 示 。 

由 于 普通 数字 PID 调节 器 的 微分 作用 只 在 第 一 个 周期 内 起 作用 ， 而 不 能 按照 偏差 变化 的 
趋势 在 整个 调节 过 程 中 起 作用 ， 因 此 第 一 个 周期 内 的 微分 作用 很 强 ， 对 于 时 间 常 数 较 大 的 系 
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计算 e(n) 计算 e(n) 
Y 
计算 aoe(n) 
计算 age(n) 





计算 aie(z-1T) 


计算 ale(n-1) 
计算 aoe(n)tale(n-1) 


1 
计算 aze(n-2) 计算 aoe(n)taie(n-1) 
计算 Au(n) 计算 aze(n-2) 
计算 Au(n)tu(n-1) 


a 
e(n—1)—> e(n-2) 

















e(n) — e(n-1) 





u(n) —— u(n-1) 





a) b) 


图 74 ”位置 型 PID 与 增 量 型 PID 控制 算法 的 程序 流程 
a) 位 置 型 PID b) 増量 型 PD 








PN 






































e(s) ul Kt + oo u(s) 
A 











不 完全 微分 环节 
图 7-5 不 完全 微分 PID 算法 结构 图 
统 ， 其 调节 作用 很 小 ， 不 能 达到 超前 控制 误差 的 目的 ， 容 易 产 生 江 出。 为 了 克服 上 述 缺 点 ， 


通常 情况 下 ， 为 了 避免 纯 微 分 运算 的 出 现 ， 可 以 在 微分 项 上 加 一 个 一 阶 惯性 环节 








? 


1 + ア 7・s 


110 


此 时 可 以 得 到 系统 的 传递 函数 为 
K K,・s 
UAI E E 
由 拉 普 拉 斯 变换 的 微分 定理 可 将 频 域 部 分 方程 转化 为 时 域 微 分 方程 并 离散 化 ， 可 求 得 算 
式 为 





(7-8) 





up(k) =Ky + (1-a) + [e(k) -e(k-1)] 

+a*up(k-1) (7-9) 
AF, oc Ay ASCENT ER — BE 0 EN Td i BR EI PPT (7-9) 可知， 引 
入 不 完全 微分 后 ， 微 分 输出 在 第 一 个 采样 周期 有 所 减 小 ， 此 后 又 按照 一 定 比 例 衰 减 ， 由 此 可 
见 ， 不 完全 微分 数字 PID 调节 器 不 但 能 抑制 高 频 干 扰 ， 而 且 克 服 了 普通 数字 PID 调节 器 的 缺 
点 。 不 完全 微分 数字 PID 调节 器 输出 的 微分 作用 能 在 各 个 周期 内 按照 偏差 的 变化 趋势 均匀 地 
输出 ， 真 正 起 到 了 微分 的 作用 ， 改 善 了 系统 的 性 能 。 由 于 在 第 一 个 采样 周期 内 不 完全 微分 数 
字 调 节 器 的 输出 比 完全 微分 数字 调节 器 的 输出 幅度 小 得 多 ， 有 效 克 服 了 智能 机 器 人 在 复杂 环 
境 下 受到 的 偏差 干扰 给 速度 控制 带 来 的 不 良 影响 ， 因 此 不 完全 微分 数字 PID 调节 器 具有 比较 
理想 的 调节 性 能 。 图 7-6 所 示 为 不 完全 微分 PID 算法 的 程序 流程 图 。 


设置 PID 参 数 


IRR RE BLK) 
AL Bic (k) 





























计算 比例 与 积分 环 
节 输 出 的 变化 量 


au(k)=aup(k)+auy(k)+aup(k) 











图 7-6 不 完全 微分 PID 算法 的 程序 流程 图 





4. 微分 先行 PID 
微分 先行 是 把 对 偏差 的 微分 改 为 对 被 控 量 的 微分 ， 这 样 在 给 定 值 变化 时 输出 不 会 产生 大 


























幅度 变化 。 而 且 由 于 被 控 量 一 般 不 会 突变 ， 因 此 即使 给 定 值 已 发 生 改 变 ， 被 控 量 也 
化 的 ， 从 而 不 致 引起 微分 项 的 突变 。 微 分 项 的 输出 增 量 > 


KT) 
7 | Ac( ヵ ) -Ac( ヵ -1) | (7-10) 


faa 
W 
Kai 
六 





Aup (n) 


由 于 竞赛 的 智能 车 在 场地 行驶 过 9 +o ol) u(t) 
Re PLS TY 2318 Bl) ER, FEAR, MO 











情况 ， 因 此 竞赛 机 器 人 的 速度 设 定 值 
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为 了 消除 设 定 值 频繁 变化 造成 的 系统 

振荡 ， 我 们 在 竞赛 机 器 人 的 速度 控制 与 方向 控制 上 引入 了 微分 先行 PID 算法 ， 该 算法 只 对 输 
出 量 ( 机 器 人 的 速度 测量 值 与 舵 机 但 转 量 ) 进行 微分 。 这 样 使 得 设 定 值 的 变化 并 不 会 影响 到 
输出 量 ， 而 被 控 量 的 变化 相对 比较 缓和 ， 这 就 很 好 地 避免 了 设 定 值 频繁 变化 给 控制 系统 造成 
的 振荡 ， 有 效 改 善 了 系统 的 动态 性 能 。 图 7-7 所 示 为 微分 先行 PID 控制 的 结构 图 。 
































7.2 PID 参数 整定 


PID 控制 器 的 参数 整定 是 控制 系统 能 否 正 常 运行 的 关键 ， 它 根据 被 控 对 象 在 控制 过 程 中 
的 动态 特性 来 确定 PID 控制 器 的 比例 系数 、 积 分 时 间 及 微分 时 间 。PID 参数 整定 方法 主要 分 
为 两 大 类 。 一 是 理论 计算 整定 法 ， 它 主要 依据 系统 的 数学 模型 ， 经 过 理论 计算 确定 控制 器 参 
数 。 这 种 方法 得 到 的 计算 数据 不 能 直接 用 ， 还 必须 通过 工程 实际 进行 调整 和 修改 。 二 是 工程 
整定 方法 ， 它 主要 依赖 于 工程 经 验 ， 直 接 在 控制 系统 的 试验 中 进行 ， 且 方法 简单 、 易 于 掌 
握 ， 在 工程 实际 中 被 广泛 采用 。 下 面 简 单 介绍 几 种 主要 的 参数 整定 方法 。 


7.2.1 临界 比例 度 法 
首先 将 PID 调节 器 的 积分 时 间 7 BERK, MAO 7, BE, 比例 度 
PID 调节 器 放大 信 数 的 倒数 ，5 = 二 |] 设置 适当 ， 当 系统 稳定 后 ， 将 比例 度 逐 渐 减 小 ， 等 得 


到 等 幅 振荡 过 程 时 ， 记 下 临界 比例 度 8。 和 临界 振荡 周期 Tk; 然后 根据 8。 与 六 的 值 查询 经 
验 公式 ( 见 表 7-2) ， 计 算出 PID 调节 器 的 主要 参数 565、 四 、 To 的 值 ; 最 后 按照 “ 先 P 后 1 最 后 
D” 的 操作 程序 微调 调节 器 整定 参数 ， 使 控制 系统 的 稳定 性 、 快 速 性 、 准 确 性 达到 最 佳 。 

表 7-2 临界 比例 度 法 经 验 公 式 






































6(%) TI /min Tp/min 
P 28x 
PI 2. 28k 7/1.2 
PID 1. 66, 0. STk 0. 25T; 


7.2.2 衰减 曲线 法 
将 PID 控制 器 设置 为 纯 比 例 控制 ， 比 例 度 6 由 大 到 小 进行 调节 ， 同 时 观察 系统 控制 过 程 
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中 出 现 衰减 比 为 4:1 时 ， 记 录 此 时 的 比例 度 8. 及 振荡 周期 内 ， 根 据 经 验 公式 ( 见 表 7-3) 计 算 
出 对 应 的 积分 时 间 T, 与 微分 时 间 7。 。 
表 7-3 衰减 曲线 法 经 验 公式 























5(% ) T\/min Tp/min 
P 6 
PI 1. 26, 0. ST, 
PID 0. 86, 0. 3T, 0. 1T, 
7.2.3 TESA 
凑 试 法 是 通过 模拟 运行 观察 系统 的 响应 (例如 阶 跃 响应 ) 曲线 ， 然 后 根据 各 调节 参数 对 





系统 响应 的 大 致 影响 ， 反 复 凑 试 参数 ， 直 至 达到 满意 的 响应 ， 从 而 确定 PID 的 调节 参数 。 增 
大 比例 系数 Ks 一 般 将 加 快 系统 的 响应 ， 这 有 利于 减 小 静 差 。 但 过 大 的 比例 系数 会 使 系统 有 
较 大 的 超 调 ， 并 产生 振荡 ， 使 稳定 性 变 坏 。 增 大 微分 时 间 Ty 有 利于 加 快 系统 响应 ， 使 超 调 
量 减 小 ， 稳 定性 增加 ， 但 对 于 干扰 信号 的 抑制 能 力 将 减弱 。 在 凑 试 时 ， 可 参考 以 上 两 种 参数 
整定 过 程 ， 对 参数 进行 先 比 例 ， 后 积分 ， 再 微分 的 整定 步 又 ， 其 具体 步骤 如 下 : 

首先 整定 比例 部 分 。 将 比例 系数 由 小 调 大 ， 并 观察 相应 的 系统 响应 ， 直 至 得 到 反应 快 、 
超 调 小 的 响应 曲线 。 如 果 系 统 没 有 项 差 或 静 差 小 到 人 允许 的 范围 之 内 ， 并 且 响 应 曲线 已 属 满 
意 ， 那 么 只 需要 用 比例 调节 需 即 可 ， 且 最 优 比例 系数 可 由 此 确定 。 

当 仅 调节 比例 调节 需 参 数 ， 系 统 的 静 差 还 达 不 到 设计 要 求 时 ， 则 需要 加 入 积分 环节 。 整 
定时 ， 首 先 将 积分 常数 7 设置 为 一 个 较 大 值 ， 经 第 一 步 整定 得 到 的 比例 系数 会 略为 缩小 (如 
减 小 20% ) ， 然 后 减 小 积分 常数 ， 使 系统 在 保持 良好 动态 性 能 的 情况 下 ， 静 差 得 到 消除 。 在 
此 过 程 中 ， 可 根据 响应 曲线 的 好 坏 反 复 修 改 比 例 系数 和 积分 常数 ， 直 至 得 到 满意 的 效果 和 相 
应 的 参数 。 

若 使 用 比例 积分 器 能 消除 静 差 ， 但 动态 过 程 经 反复 调整 后 仍 达 不 到 要 求 ， 则 可 加 入 微分 
环节 。 在 整定 时 ， 先 置 微分 常数 7。 为 零 ， 在 第 二 步 整 定 的 基础 上 增 大 7,， 同 时 相应 地 改变 
K 与 71， 逐步 竣 试 ， 以 获得 满意 的 调节 效果 和 参数 。 


7.3 数字 PID 控制 算法 改进 

为 了 解决 机 器 人 实际 运行 过 程 中 过 到 的 问题 以 便 提高 PID 控制 性 能 ， 我 们 对 数字 PID 控 
制 算法 进行 一 些 改进 ， 本 节 将 主要 就 改进 积分 作用 和 微分 作用 进行 介绍 。 
7.3.1 积分 项 改进 


1. 私 分 分 高 

积分 分 离 PID 算法 是 在 偏差 较 大 时 ， 为 避免 超 调 量 过 大 而 导致 系统 响应 时 间 延 长 ， 暂 时 
取消 积分 作用 ; 当 偏 差 值 小 于 设 定 阀 值 时 ， 再 重新 投入 积分 作用 以 保证 系统 的 控制 精度 。 

职 分 分 离 PID 控制 算法 的 表达 式 为 


ulk) = K,e(k) + BK, È, eli) + Ky 























e(k) -elk -1) 
T, 





(7-11) 
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1 e(k) |< 
P, T 为 采样 周期 :6 为 积分 分 离 的 开关 系数 ， 根 据 公式 8= |0 O SE, ttt 
定 要 根据 实际 系统 来 定 。 若 s 值 过 大 ， 则 达 不 到 积分 分 离 的 目的 ; 若 e 值 过 小 ， 则 会 导致 系 
统 无 法 进入 积分 区 ， 从 而 使 系统 出 现 余 差 。 
采用 普通 PID 控制 的 阶 跃 响应 曲线 如 图 7-8 所 示 。 采 用 积分 分 离 PID 的 阶 跃 响 应 曲线 如 
图 7-9 所 示 。 
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图 7-8 普通 PID 控制 的 阶 跃 响应 曲线 
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图 7-9 采用 积分 分 离 PID 的 阶 跃 响应 曲线 
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从 仿真 结果 可 以 看 到 系统 的 精度 很 好 ， 采 用 积分 分 离 PID 控制 算法 ， 系 统 的 控制 效果 有 
很 大 的 改善 。 因 此 本 系统 可 以 应 用 于 各 种 对 精度 要 求 较 高 的 控制 场合 。 
. 变速 积分 


变速 积分 PID 算法 的 积分 项 表达 形式 如 下 : 
renee ri X eps fleo Ie fi (7-12) 


式 中 , AB fle(k) |W ek) 的 函数 ; Sl e(k) | 增 大 时 , Lek) ] 减 小 ， 反之 则 增 大 。 

变速 积分 PID 算法 的 基本 思路 是 ， 根 据 偏差 的 大 小 ， 相 应 改变 积分 项 累加 的 速度 ， 偏 差 
越 大 ， 积 分 越 慢 ; 偏差 越 小 ， 积 分 越 快 。 变 速 积分 PID 算法 能 较 好 地 解决 标准 PID 算法 中 积 
分 系数 取 大 会 产生 超 调 ， 甚 至 积分 饱和 ; 取 小 则 又 延长 了 消除 静 差 的 时 间 的 矛盾 。 采 用 普通 
PID 控制 的 阶 跃 响应 曲线 如 图 7-10 所 示 ， 积 分 速率 采用 变速 积分 控制 的 阶 跃 响应 曲线 如 图 
7-11 所 示 。 
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图 7-10 普通 PID 控制 的 阶 跃 响应 曲线 





由 图 7-10 和 图 7-11 的 仿真 结果 可 以 看 出 ， 变 速 积分 使 得 系统 的 调节 时 间 有 所 减 小 ， 稳 
定 精 度 有 所 提高 。 
7.3.2 微分 项 改进 

由 于 微分 作用 是 在 相 邻 的 采样 周期 内 进行 的 ， 因 此 它 的 强 弱 不 仅 与 微分 时 间 To, 放 大 
系数 Kp 有 关 ， 而 且 与 采样 周期 了 也 有 明显 关系 。 当 了 大 小 时 ， 两 次 采样 之 间 被 控 参 数 的 变 
化 一 般 也 不 会 太 大 ， 因 而 微分 作用 较 弱 。 所 以 通过 增加 微分 时 间 To 和 放 大 系 数 た 来 加 强 采 
样 周期 内 的 微分 作用 ， 这 样 一 来 ， 系 统 的 稳定 性 及 抗 干 扰 能 力 就 会 减弱 ， 所 以 对 微分 项 的 改 
进 应 该 从 减少 干扰 与 降低 数据 误差 下 手 。 
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图 7-11 采用 变速 积分 控制 的 阶 跃 响应 曲线 





























1. 偏差 平均 
偏差 平均 的 公式 为 

















TE ー ア < の) (7-13) 


式 中 , 平均 項 数 m 取决 于 被 控 对 象 的 特性 。 一 般 流量 信号 m 取 10， 压 力 信 号 m 取 5， 温度 
等 缓慢 变化 的 信号 台 取 2 或 1。 

2. 测量 值 微分 

当 控 制 系统 的 给 定 值 r(n) 发 生 阶 跃 变化 时 ， 微 分 动作 将 导致 控制 量 u(n) 的 大 幅 变 化 ， 
这 样 不 利于 生产 的 稳定 操作 。 因 此 ， 在 微分 项 中 不 考虑 给 定 值 r(n)， 只 对 测量 值 yY(n)( 即 
被 控 量 ) 进行 微分 。 考 虑 到 在 正 反 作用 下 ， 偏 差 的 计算 方法 不 同 ， 即 





e(n) =y(n) -r(n)( 正 作用 ) (7-14a) 
e(n) =r(n) -y(n)( 反 作用 ) (7-14b) 

参照 式 (7-6) 中 的 微分 项 
Aup(n) =Kyle(n) -2e(n-1) +e(n-2) | (7-15) 

改进 后 的 微分 项 算式 为 
Auy(n) =Kyly(n) -27(2-1) +y(n-2)1( 正 作用 ) (7-16a) 
Aup(n) =Ky[r(n) -2r(n-1) +r(n-2)]( 反 作用 ) (7-16b) 





必须 注意 ， 对 串 级 控制 的 副 级 控制 的 副 调 节 器 而 言 ， 因 给 定 值 是 主 调节 器 的 输出 控制 
量 ， 故 上 述 仅 对 测量 值 进行 微分 的 做 法 并 不 适用 ， 仍 应 按 原 微分 项 算式 (7-15 ) 对 偏差 进行 微 
分 。 测 量 值 微分 也 称 微分 先行 。 
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7.4 PID 控制 在 竞赛 智能 车 上 的 实现 


智能 车 的 速度 取决 于 车 模 自 身 驱 动 电动 机 的 转速 ， 驱 动 电动 机 的 转速 受制 于 电动 机 驱动 
模块 输出 电流 的 大 小 ， 电 动机 驱动 模块 输出 电流 的 大 小 受制 于 智能 车 控制 核心 一 一 单片机 输 
出 的 脉冲 频率 和 占 空 比 。 当 单片机 输出 的 脉冲 频率 为 定 值 时 ， 脉 冲 占 空 比 越 大 ， 驱 动 电动 机 
转速 越 高 ; 反之 ， 转 速 就 低 。 在 智能 车 行驶 过 程 中 ， 如 果 赋 予 智 能 车 驱动 电动 机 以 较 高 速 
度 ， 则 车 横 在 直道 行驶 中 不 会 有 任何 问题 ; 但 车 模 在 通过 弯 道 时 ， 由 于 车 模 方 向 控制 的 机 械 
系统 具有 惰性 ， 和 车辆 自身 也 具有 惯性 ， 因 此 和 车模 极 易 从 弯 道 的 入口 处 冲 出 赛 道 。 所 以 欲 保证 
智能 车 在 不 冲 出 赛 道 的 前 提 下 达到 一 定 的 平均 速度 ， 则 智能 车 的 速度 必须 是 可 变 的 ， 即 直道 
速度 要 快 ， 弯 道 速度 要 慢 ， 且 速度 控制 系统 的 响应 时 间 要 短 。 因 此 ， 参 赛 选手 在 智能 车 速度 
控制 系统 的 选取 上 多 半 采 用 由 PID 控制 絮 组 成 的 闭环 控制 系统 。 


7.4.1 PID 控制 器 输入 标准 值 的 设 定 


因为 智能 汽车 在 运行 过 程 中 ， 和 车 速 必须 随 赛 道 的 变化 而 变化 ， 所 以 车 的 速度 对 于 某 个 路 
段 来 说 是 恒定 的 ， 而 对 于 整个 赛 道 来 讲 又 是 变速 的 。 因 此 该 系统 中 的 PID 控制 器 所 要 输入 的 
标准 值 一定 要 受 控 于 路 径 传感器 的 输出 电压 。 基 本 方法 是 : 对 路 径 传 感 需 输出 的 有 效 电压 取 
绝对 值 ， 然 后 再 乘 以 固定 系数 ， 用 得 到 的 积 作为 输入 标准 电压 。 


7.4.2 PID 控制 器 被 控 对 象 控制 参量 的 设 定 


智能 汽车 中 的 驱动 电动 机 是 PID 控制 器 的 受 控 对 象 ， 电 动机 的 速度 由 单片机 输出 的 
PWM 脉冲 频率 和 脉 宽 决定 ， 在 实际 操作 过 程 中 采用 频率 固定 、 脉 宽 可 调 的 方法 进行 控制 。 
驱动 电动 机 理想 速度 还 受 赛 道 材料 的 摩擦 力 、 赛 道路 径 变 化 等 条 件 制约 ， 所 以 驱动 电动 机 的 
标准 控制 参量 一 般 预 设 3 个 固定 值 ， 一 个 为 直道 时 的 控制 参量 ， 其 余 两 个 为 不 同 角度 弯 道 时 
的 控制 参量 。 预 设 的 控制 参量 是 否 合适 ， 还 需要 在 车 模 试 跑 中 予以 调整 ， 以 保证 车 模 在 不 冲 
出 赛 道 时 保持 尽 可 能 快 的 速度 。 


7.4.3 ”智能 汽车 车 速 PID 控制 器 的 工作 原理 


智能 汽车 车 速 PID 控制 器 系统 结构 框图 如 图 7-12 所 示 。 路 径 传感器 在 系统 中 负责 检测 
赛 道 的 变化 情况 ， 并 完成 将 赛 道 位 置信 息 转 换 为 电压 信息 的 任务 。 滤 波 器 用 以 滤 除 路 径 传 感 
器 和 输出 电压 中 的 干扰 成 分 ， 并 负责 对 路 径 传感器 输出 电压 进行 一 定 的 调整 ， 然 后 将 此 电压 作 
为 车 速 PID 控制 器 系统 中 的 标准 输入 电压 。 采 样 电路 用 来 检测 电动 机 转速 ， 并 负责 将 速度 信 
息 转 换 为 电压 信息 。 反 馈 电路 将 采样 电路 输出 的 电压 变换 后 形成 送 往 比 较 器 ， 与 通过 比较 需 
求 代 数 和 ， 然 后 将 值 送 往 PID 控制 单元 。PID 控制 单元 对 该 值 进行 处 理 ， 处 理 后 的 结果 送 往 
PWM 控制 电路 ， 用 以 控制 PWM 电路 输出 的 脉冲 宽度 ， 最 终 起 到 控制 驱动 电动 机 的 作用 。 

普遍 应 用 于 工业 自动 化 控制 领域 的 PID 控制 右 是 一 个 具有 反馈 环节 的 自动 化 控制 系统 。 
在 智能 汽车 车 速 控 制 中 应 用 PID 控制 器 可 以 有 效 控制 智能 汽车 在 不 同 赛 道 上 的 速度 ， 且 具有 
速率 变化 迅速 及 运行 平稳 的 特点 。 需 要 注意 的 是 ， 此 系统 中 的 输入 标准 值 和 输出 标准 值 需要 
根据 不 同 赛 道 参数 和 不 同类 型 的 电动 机 在 实践 中 予以 设 定 和 调整 。 
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滤波 路 径 传感器 PWM 
7 の 
中 驱动 电动 机 
了 e(t) 
7 の 采样 




















7.4.4 能 机 的 PD 控制 


対 能 机 米 用 PD 控制 是 各 类 竞赛 智能 车 常用 的 控制 方法 ， 其 表达 式 为 
output = K,e + Ki Ye + K, Ae (7-17) 
AP, e 为 车 身 与 跑道 的 偏 移 量 ; Kp 为 比例 系数 ; Ki 为 积分 系数 ; Kp 为 微分 系数 ; output 
为 舵 机 PWM 输出 量 ; Ae 为 上 一 次 偏 移 量 与 当前 偏 移 量 之 差 。 在 该 PD 控制 中 ， 起 主要 作用 
的 是 比例 项 。 由 于 积分 项 会 导致 能 机 转向 延迟 ， 故 常 将 积分 系数 K 置 零 。 在 实际 比赛 过 程 
中 适当 调节 微分 系数 Ko 能 使 智能 车 优化 路 径 ， 达 到 更 好 的 转向 效果 。 


7.5 ”模糊 控制 算法 


























人 


7.5.1 模糊 控制 基本 原理 


竞赛 机 器 人 在 场地 运动 的 过 程 中 ， 路 径 规 划 控 制 系统 具有 高 度 不 确定 性 ， 是 一 个 多 输入 
多 输出 (Multiple-Input Multiple-Output, MIMO) 系统 。 对 于 这 种 具有 高 度 不 确定 性 的 MIMO 系 
统 ， 传统 的 控制 方法 不 能 达到 很 好 的 控制 效果 。 模 糊 推 理 控制 方法 将 人 类 的 驾驶 经 验 融 人 系 
统 控 制 之 中 ， 因 此 可 以 较 好 地 满足 系统 自 适应 性 、 和 鲁 棒 性 和 实时 性 的 要 求 。 模 糊 控制 方式 借 
助 模 糊 数学 这 一 工具 ， 通 过 推理 来 实现 控制 。 模 糊 逻 辑 模拟 了 人 类 思维 的 模糊 性 ， 它 采用 与 
人 类 语言 相近 的 语言 变量 进行 推理 ， 因 此 借助 这 一 工具 可 以 将 人 类 的 控制 经 验 融 入 系统 控制 
之 中 ， 使 得 系统 可 以 像 有 经 验 的 操作 者 一 样 去 控制 复杂 系统 。 总 的 说 来 模糊 控制 具有 以 下 特 
点 : 中 不 依赖 于 被 控 对 象 的 精确 数学 模型 ， 易 于 对 不 确定 性 系统 进行 控制 ; @ 是 一 种 易于 控 
制 、 易 于 掌握 的 较 理想 非 线性 控制 器 ， 是 一 种 语言 控制 器 ; @) 抗 干扰 能 力 强 ， 响 应 速度 快 ， 
并 对 系统 参数 的 变化 有 较 强 的 鲁 棒 性 。 模 糊 控制 器 的 基本 结构 由 模糊 输入 接口 、 模 糊 推 理 及 
模糊 输出 接口 三 个 模块 组 成 。 模 糊 输 入 接口 的 主要 功能 是 实现 精确 量 的 模糊 化 ， 即 把 物理 量 
的 精确 值 转换 成 语言 变量 值 。 语 言 变量 的 分 档 根据 实际 情况 而 定 ， 一 般 分 为 3 ~7 档 ， 档 数 
越 多 ， 控 制 精度 越 高 ， 计 算 量 也 越 大 。 模 糊 推理 决策 机 构 的 主要 功能 是 模仿 人 的 思维 特征 ， 
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根据 总 结 人 工控 制 策 略 取得 的 语言 控制 规则 进行 模糊 推理 ， 并 决策 出 模糊 输出 控制 量 。 模 糊 
输出 接口 的 主要 功能 是 把 模糊 输出 量 转化 为 精确 量 ， 施 于 被 控 对 象 。 

模糊 控制 系统 结构 如 图 7-13 所 示 ， 其 与 传统 控制 系统 最 大 的 区 别 在 于 采用 了 模糊 控制 
髓 。 























一 \ 
模糊 控制 器 























图 7-13 模糊 控制 系统 结构 图 





模糊 控制 器 主要 由 模糊 化 、 知 识 库 、 模 糊 推理 和 清晰 化 这 四 部 分 组 成 ， 如 图 7-14 所 示 。 
首先 把 输入 的 精确 量 转换 成 模糊 量 ; 知识 库 包含 了 具体 应 用 领域 的 知识 和 要 求 的 控制 目标 和 
规则 等 ， 由 数据 库 和 模糊 规则 库 两 部 分 组 成 ; 模糊 推理 是 模糊 控制 器 的 核心 ， 它 具有 模拟 人 
的 模糊 概念 推理 能 力 ， 输 入 量 经 由 模糊 推理 得 到 模糊 控制 量 ; 再 经 过 解 模糊 变换 为 用 于 实际 
控制 的 清晰 量 ， 作 用 于 被 控 对 象 。 
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图 7-14 模糊 控制 器 主要 组 成 结构 
7. 5.2 ”模糊 控制 器 的 设计 


模糊 控制 右 输 入 输出 语言 变量 的 选取 应 该 尽量 简单 ， 同 时 又 要 考虑 机 絮 人 行驶 和 避让 障 
碍 物 的 实际 情况 ， 较 好 地 反应 机 器 人 避 障 的 过 程 ， 这 里 以 避 障 机 器 人 为 例 ， 设 dr 为 右 侧 隐 
ØER, de 为 前 方 隐 碍 物 距离 ，dl 为 左 侧 障 碍 物 距 离 ; 方位 传 感 融 测 得 航向 与 目标 点 到 
机 器 人 连 线 的 夹 角 为 好。 因此 模糊 控制 器 的 四 个 输入 变量 分 别 是 由，de，dl 和 tg; 模糊 控制 
器 的 输出 变量 有 一 个 ， 即 机 器 人 转向 角 sao 

模糊 语言 的 确定 包括 由 语法 规则 生成 适当 的 模糊 语言 值 ， 根 据 语 义 规 则 确定 隶属 度 函 数 
及 模糊 变量 的 论 域 等 。 这 里 使 用 连续 型 论 域 ， 采 用 简单 线性 化 处 理 方法 ， 对 每 个 输入 量 进 行 
模糊 语言 描述 ， 如 下 : 
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距离 输入 变量 : d={ 近 , 近 「 =| near, far} 
目标 方位 输入 变量 : tg =|AK, AP, Av), 前 , 右 小 , A, AKI 

= {lb, Im, ls, zo, rs, rm, rb} 
输出 转向 角 变 量 : sa = | Ae, AR, A, EGE, AMHR, APH, AH; 

= |tlb, tlm, tls, tz, trs, trm, trb} 
OT El ets BT A TE TOS od, em OL tl AS RE BB S 
越 多 ， 控 制 越 精细 ， 但 对 应 控制 规则 的 数目 也 就 越 多 ; OAL, ERE PE BE 
进行 细致 调整 。 所 以 ， 模 糊 分 割 的 数目 并 无 指导 性 的 方法 ， 主 要 根据 具体 情况 和 经 验 来 划 
分 。 例 如 上 面 对 距离 输入 变量 的 划分 ,通常 情况 下 对 距离 变量 划分 为 | 近 ， 中 ， 远 | ,但 如 
此 一 来 ， 模 糊 规 则 的 数量 共有 3 x 7 = 189 条 ， 较 难 实现 。 因 此 将 距离 变量 简单 划分 为 | 近 ， 
远 | ,模糊 规则 数 减 少 到 2° x7 =56 条 。 模 糊 规 则 数 大 幅 减少 ， 既 容易 实现 ， 又 未 过 多 降低 
控制 精度 。 
模糊 语言 值 只 是 一 个 模糊 子 集 ， 语 言 值 要 通过 隶属 函数 来 描述 。 在 论 域 连 续 的 情况 下 ， 
隶属 度 常用 函数 的 形式 来 进行 描述 ， 和 常见 的 隶属 函数 有 三 角形 、 梯 形 、 高 斯 型 等 。 通 常 ， 隶 
属 函 数 的 形状 越 陡 ， 分 辩 率 越 高 ， 控 制 灵 人 敏 度 也 就 越 高 ; 相反 ， 大 隶属 函数 变化 缓慢 ， 则 控 
制 特性 也 平缓 ， 对 应 的 系统 稳定 性 好 。 因 此 ， 在 选择 隶属 度 函 数 时 ， 一 般 在 误差 为 零 的 区 域 
附近 采用 分 辨 率 较 高 的 隶属 函数 ， 而 在 误差 较 大 的 区 域 ， 可 采用 分 辨 率 较 低 的 隶属 函数 ， 以 
获得 较 好 的 鲁 棒 性 。 此 外 ， 大 多 数 情况 下 ， 隶属 函数 的 选取 具有 较 大 的 随意 性 ， 对 同一 模糊 
集 不 同 的 人 可 以 选取 不 同 的 隶属 函数 去 表述 ， 并 无 绝对 的 对 错 。 因 此 ， 可 以 通过 改变 隶属 函 
数 来 观察 模糊 控制 器 输出 的 变化 。 各 输入 输出 变量 隶属 函数 如 图 7-153、 图 7-16、 图 7-17 所 
不 。 
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l. 
图 7-15 dl, de 和 dr 的 隶属 函数 








模糊 规则 的 建立 是 模糊 控制 的 核心 问题 。 模 糊 控制 系统 是 用 一 系列 基于 专家 知识 的 语言 
来 描述 的 ， 用 一 系列 模糊 条 件 描述 的 模糊 控制 规则 就 构成 了 模糊 控制 规则 库 。 根 据 模糊 控制 
理论 ， 控 制 规则 反映 了 输入 输出 变量 间 的 关系 。 机 器 人 转向 的 基本 原则 是 : 当 探 测 到 机 器 人 
左 / 右 和 前 方 有 障碍 物 靠近 时 ， 机 器 人 应 及 时 转向 右 / 左 方 。 转 向 角度 的 大 小 则 视 障 碍 物 距离 
和 航向 与 目标 点 到 机 器 人 连 线 的 夹 角 而 定 ， 障 但 物 距 离 越 近 ， 转 向 角 越 大 ; 夹 角 越 大 ， 转 向 
角 越 小 。 根 据 前 面 所 确定 的 输入 输出 集 ， 模 糊 规则 的 一 般 表述 形式 为 “if( 条 件 ) then( 结 
果 )”。 机 器 人 一 侧 有 障碍 物 是 最 基本 的 情况 ， 这 里 仪 以 右 侧 有 障碍 物 的 情况 来 说 明 。 当 机 
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图 7-17 输出 转向 角 sa 的 隶属 函数 


器 人 右 侧 近 距 离 内 有 障碍 物 ， 而 左 侧 和 前 方 近 距 离 内 均 无 障碍 物 时 。 当 左右 障碍 物 对 称 时 ， 
根据 基本 规则 ， 机 器 人 将 无 法 确定 行进 方向 而 在 两 障碍 物 间 来 回转 向 ， 形 成 死 锁 。 在 这 种 情 
况 下 ， 目 标 方位 角 tg 则 会 决定 机 器 人 的 转向 ， 这 就 是 局 部 最 优选 择 。 用 模糊 逻辑 表示 如 下 : 

如果 de Aik, dr Aw, dl Wit, 且 目 标点 在 机 器 人 左 侧 ， 则 机 器 人 左 转 ; 让 (dr is 
near)and(dc is near) and(dl is near)and(tg is ls), then(sa is tlb), 

如果 de Ait, dl 为 远 ，dr 为 过 ， 且 目标 点 在 机 器 人 右 侧 ， 则 机 器 人 右 转 。 

if(dr is near)and(dc is near)and(dl is near) and(tg is rs), then(sa is trb) 。 

按照 同样 的 方法 ， 针 对 不 同方 位 的 障碍 物 和 目标 方位 角 ， 可 制定 完备 的 控制 规则 。 这 样 
的 规则 制定 方法 是 基于 控制 器 行为 特征 的 方式 ， 将 动作 分 为 否 干 的 基本 行为 ， 对 于 较 复杂 的 
行为 ， 则 分 由 几 个 较 简 单 的 行为 依次 构成 。 这 样 可 简化 模糊 规则 的 制定 ， 减 少 模糊 规则 的 条 
数 ， 避 开 被 控 对 象 特 征 的 建 模 。 模 糊 控制 规则 经 简化 后 ， 放 入 模糊 规则 库 ， 供 模糊 控制 器 查 
询 。 

欧 赛 乔 能 车 多 采用 两 轮 驱 动 ， 通 过 对 电动 机 转速 与 智能 车 位 置 的 反馈 ， 左 、 右 轮 驱 动 电 
PRE BES PID 调节 ， 而 对 PID 控制 进行 修正 则 可 以 使 用 模糊 控制 器 。 智 能 车 运行 过 程 的 系统 
结构 图 如 图 7-18 所 示 。 

在 转向 控制 算法 中 ， 如 果 仅 采用 PID 控制 算法 ， 则 为 了 使 机 器 人 行进 顺畅 ， 需 要 在 直线 
运动 偏差 较 小 时 缓慢 调节 其 至 不 调节 ; 在 遇 到 弯 道 产生 大 的 偏差 时 ， 航 机 能 够 迅速 动作 。 这 
就 使 得 偏差 量 比 例 系数 P 是 一 个 变量 ， 即 该 参数 呈 非 线性 特征 ， 由 于 P 是 一 个 离散 的 数值 ， 
因此 将 导致 转向 调节 的 阶 跃 式 变化 ， 一 方面 机 器 人 对 路 径 变 化 反应 不 灵敏 ， 男 一 方面 也 使 得 
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测量 采样 
左轮 电动 机 
















左轮 PID 调 节 





左轮 驱动 电路 











右 轮 PID 调 节 








右 轮转 速 修正 











左轮 转速 修正 








图 7-18 智能 车 运行 过 程 的 系统 结构 图 





控制 系统 易 产 生 超 调 及 振荡 现象 。 对 于 追求 高 车 速 、 短 决策 周期 控制 策略 的 智能 机 器 人 来 
说 ， 通 过 在 PID 调节 的 基础 上 辅助 采用 模糊 控制 算法 ， 可 以 有 效 增 强 系统 控制 响应 速度 及 对 
不 确定 因素 的 适应 性 。 在 寻 迹 与 避 障 类 竞赛 中 对 机 器 人 舵 机 及 电动 机 控制 多 采用 模糊 控制 算 
法 O 


7.6” 赛 道 记忆 算法 


全 国 大 学 生 智能 汽车 苋 赛 的 规则 为 记忆 算法 在 智能 汽车 控制 系统 中 的 应 用 提供 了 条 件 。 
比赛 中 智能 车 在 赛 道上 连续 跑 两 图 ， 并 记 其 中 最 好 圈 成 绩 为 比赛 成 绩 。 如 图 7-19 所 示 ， 赛 
道 记忆 算法 在 第 一 圈 以 最 安全 的 速度 缓慢 驶 过 一 圈 ， 并 将 赛 道 信息 保存 下 来 ， 第 二 图 根据 保 
存 下 来 的 信息 进行 车 速 和 转角 决策 的 相应 最 优化 ， 从 而 在 第 二 圈 取 得 好 成 绩 。 无 论 智能 车 的 
传感器 前 瞻 距 离 有 多 远 ， 在 跑 圈 时 它 都 只 能 预测 在 一 段 有 限 距 离 内 赛 道 的 情况 。 而 采用 赛 道 
记忆 算法 的 智能 车 ， 在 第 二 圈 时 已 对 整个 赛 道 有 了 全 面 的 认识 ， 从 而 在 相同 条 件 下 ， 将 比 不 
使 用 赛 道 记忆 的 智能 车 更 具 优势 。 
































第 一 圈 赛 道 信 息 


转角 策略 第 二 图 
调 速 策略 


图 7-19 ”记忆 算法 原理 
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7.6.1 赛 道 记忆 算法 前 提 


要 想 成 功 实现 赛 道 记忆 算法 ， 必 须 满 足以 下 4 点 要 求 : 

1) 赛车 在 第 一 圈 必 须 安全 走 完 全 程 。 在 第 一 圈 ， 赛 车 的 最 主要 目的 不 是 为 了 快速 跑 完 
全 程 ， 而 是 采集 赛 道 信息 ， 如 果 智 能 汽车 在 第 一 圈 出 现 冲 出 赛 道 的 情况 ， 则 赛 道 记忆 功能 也 
会 将 错误 的 信息 记录 下 来 ， 导 致 第 二 圈 在 此 处 控制 算法 无 法 矫正 偏差 。 因 此 使 用 赛 道 记忆 算 
法 的 智能 车 ， 在 第 一 圈 一 般 都 会 采用 较 缓 慢 的 匀速 走 完全 程 。 

2) 赛车 必须 能 明确 分 辨 出 赛 道 起 点 线 和 十 字 交 义 线 的 区 别 。 根 据 “ 飞 思 卡 尔 " 杯 智能 车 
比赛 的 比赛 规则 ， 在 赛 道 计时 起 点 两 边 各 有 一 个 长 度 为 0. lm 的 黑色 计时 起 跑 线 ， 把 智能 汽 
车 前 端 通过 起 始 线 作 为 比赛 的 开始 或 结束 时 刻 。 同 时 ， 由 于 赛 道 可 以 交叉 ,交叉 角 为 90 ， 
因此 采用 赛 道 记忆 算法 的 智能 车 需要 判断 赛 道 起 始 线 与 交叉 线 ， 从 而 分 辨 出 自己 正在 进行 第 
几 圈 。 

3) 客车 必须 能 够 有 足够 记录 一 圈 赛 道 数据 的 内 存 空间 。 由 于 单片机 想 片 的 RAM 容量 
限 ， 因 此 算法 研究 者 需要 对 算法 进行 优化 处 理 ， 改 变 保存 的 格式 以 节省 内 存 空间 。 

4) 在 跑 第 一 圈 时 ， 赛 车 需 即 时 对 当前 赛 道 数据 进行 处 理 ， 避 免 第 二 圈 时 还 在 进行 数据 
处 理 而 给 赛车 的 控制 实时 性 带 来 不 良 的 影响 。 

7. 6.2” 赛 道 记忆 算法 描述 

采用 赛 道 记忆 算法 的 智能 车 行驶 过 程 如 图 7-20 所 示 ， 第 一 圈 的 主要 目的 就 是 将 赛 道 的 
重要 特征 按 特定 的 格式 记录 下 来 ， 作 为 第 二 圈 的 参考 。 初 圈 最 终 要 记录 的 数据 的 横 坐 标 一 般 
为 行驶 的 路 程 ， 而 纵 坐 标 则 为 赛 道 此 点 的 曲率 半径 。 对 于 横 坐 标 ， 由 于 初回 一 般 匀 速 驶 完 ， 
因此 可 以 直接 用 时 间 来 表示 ， 也 可 以 用 车 速 传感器 的 当前 脉冲 数 来 表示 。 而 对 于 纵 坐 标 则 无 法 
第 一 时 间 取 得 当前 点 的 曲率 半径 ， 它 需要 对 采集 到 的 原始 数据 进行 相关 处 理 后 才能 得 出 。 在 初 
圈 中 ， 我 们 能 记录 的 只 是 当前 的 转角 设 定 值 ， 可 用 舵 机 占 空 比 或 直接 转换 过 来 的 角度 值 表示 。 

在 第 二 圈 ， 由 于 智能 车 本 身 的 某 些 局 限 性 ， 如 舵 机 响应 时 间 、 赛 道 摩擦 系数 、 轮 胎 抓 地 
力 、 传 感 器 布局 等 因素 的 影响 ， 因 此 对 于 某 种 特定 弯 道 ， 智 能 车 有 它 所 谓 的 极限 速度 。 如 果 
我 们 利用 初 圈 得 到 弯 道 的 曲率 半径 后 ， 在 过 各 弯 道 时 将 车 速 调 至 它 相 应 的 极限 速度 ， 那 么 理 
论 上 这 就 是 它 所 能 跑 出 的 最 优 成 绩 了 。 对 于 直道 ， 特 别 是 长 直道 ， 更 能 发 挥 赛 道 记忆 算法 的 
优势 。 例 如 ， 如 果 在 初 圈 记 忆 后 得 到 某 段 直道 为 2800 个 脉冲 点 长 ， 那 么 在 决策 中 就 可 在 前 
2500 个 脉冲 时 起 动 电动 机 用 最 大 占 空 比 加 速 ， 超 过 2500 脉冲 时 直接 减速 ， 将 速度 调 在 下 一 
个 弯 道 的 极限 速度 进行 过 弯 。 由 于 事先 已 经 知道 直道 的 长 度 ， 因 此 调 速 策略 更 能 有 的 放 矢 ; 
对 于 小 S 弯 道 ， 可 以 采取 高 速 直 线 过 弯 的 策略 。 为 了 安全 起 见 也 可 以 采用 之 后 过 弯 的 策略 让 
智能 车 采取 较 小 的 转角 高 速 过 付 ; 对 于 圆 形 弯 道 ， 需 要 在 弯 道 的 曲率 和 过 弯 的 速度 之 间 做 一 
个 权衡 ， 当 行驶 曲率 较 大 时 ， 智 能 车 可 以 以 较 大 的 速度 行驶 ， 当 进入 内 圈 后 ， 由 于 半径 减 
小 ， 离 心力 增 大 ， 此 时 宜 降 低 车 速 平 稳 通过 。 由 于 智能 车 保有 对 初 圈 的 记忆 ， 因 此 跑 第 二 圈 
时 可 以 直接 得 出 下 个 弯 道 是 左 抛 还 是 右 扮 。 这 样 逢 能 车 就 可 以 按 比 规定 更 小 的 曲率 半径 通过 
赛 道 ， 从 而 减少 了 经 过 路 径 ， 也 节约 了 时 间 。 同 样 ， 一 般 赛 车 在 直道 上 高 速 行驶 时 经 常会 出 
现 来 回 振荡 的 现象 。 如 果 经 过 初 圈 记 忆 ， 则 赛车 判断 自己 正 处 于 直道 时 可 以 进行 相应 的 措 
施 ， 便 能 很 好 地 解决 这 个 问题 。 
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图 7-20 记忆 算法 软件 控制 流程 图 
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虽然 赛 道 记忆 算法 可 以 大 大 提高 赛车 的 成 绩 , 但 目前 来 讲 ， 在 实际 使 用 过 程 中 想 取得 好 





的 成 绩 ， 还 需要 做 更 深入 的 研究 工作 。 原 因 主 要 有 以 下 两 点 : 


第 一 ， 目 前 大 学 生 智能 车 比赛 的 赛 道 有 着 越 来 越 复杂 、 越 来 越 长 的 趋势 ， 十 字 交 又 线 也 





将 不 只 出 现 一 个 ， 这 对 初 圈 记 忆 和 数据 处 理 都 产生 了 很 大 的 挑战 ; 














第 二 ， 由 于 决赛 之 前 赛 道 是 不 公布 的 ， 因 此 赛 道 记忆 算法 存在 很 大 的 风险 ， 较 保守 和 安 


全 的 算法 在 决赛 中 可 能 更 有 利 。 











昌 然 赛 道 记忆 算法 存在 一 定 的 风险 ， 但 是 它 独特 的 思路 却 是 值得 继续 发 展 下 去 的 ， 有 着 


很 大 的 发 展 潜力 。 
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第 8 草 工程 化 应 用 实例 








(竞赛 ) 机 器 人 的 工程 化 流 备 应 用 ， 越 来 越 受 到 业界 的 高 度 重视 ， 其 市 场 应 用 也 越 来 越 
广阔 。 因 此 本 章 以 目前 稍 i ee oy eae 
例 进行 说 明和 分 析 ， 同 时 将 其 作为 信息 物理 系统 (CPS ) HASSE Se Bi DT A SRE o 


8.1 ”交流 电动 机 矢量 控制 理论 


在 大 型 起 重 装备 中 ， eens i 安全 节能 等 方面 考虑 ， 都 应 用 笼 型 感应 电动 机 作 
为 驱动 装置 。 本 市 主 要 分 析 和 研究 Wve HE SHALE e 


8.1.1 感应 电动 机 的 空间 矢量 


任何 在 空间 按 正 弱 形 式 分 布 的 物理 量 都 可 以 用 空间 矢量 表示 。 下 面 以 感应 电动 机 定子 绕 
组 为 例 ， 感 应 电动 机 的 定子 绕组 均 采 用 对 称 的 三 相 绕 组 ， 当 三 相交 流 电 流 记 ， 记 ， ic 流入 三 
相 绕 组 后 ， 就 形成 旋转 的 绕组 磁 势 。 若 略 去 空间 谐 波 磁 势 ， 则 各 相 绕组 产生 的 基 波 磁 势 可 分 
别 用 每 相 磁 势 空 nee ee o A 
瞬时 值 成 正比 ， 其 方向 代表 基 波 磁 势 幅 值 所 在 的 方向 ， 分 别处 于 各 相 绕 组 的 轴线 上 。 

波 磁 势 空间 矢量 如 图 8-1 所 示 。 
在 图 8-1 中 ， 若 取 轴 线 4 作为 实 轴 Re， 虚 轴 Im 领 前 于 实 轴 Re， 则 在 此 电动 机 前 面 的 空 
间 复 平面 内 ， 有 下 列 关 系 式 成 立 : 
F,=Fy,e =F,; Fy =Fye =aFy; Fe Fie Fe =a’ Fe 
式 中 , Fy, Fy, Fo 分 别 表示 各 相 基 波 磁 势 的 幅 值 。 
B 


-20 =. OF ges o 一 £ ] 一 一 
=e =cos120° + jsinl20° = -— +] 
2 2 


根据 矢量 合成 法 则 ， 将 各 相 磁 势 空间 矢量 Fa, Fy 


Fe 相 加 ， 可 得 到 三 相合 成 磁 势 空间 矢量 。 取 合成 磁 势 
的 2/3 定义 为 磁 势 空间 综合 矢量 (简称 为 定子 磁 势 空间 


RE), HF 表示 ， 则 有 
























































P= (P+ +P.) (8-1) 
人 磁 势 空间 矢量 可 表示 为 图 8-1 基 波 磁 势 空间 矢量 
P, =E F, +aFp + Fe) (8-2) 


FA Pek AC TA GE EC, 因 此 在 三 相 系 銃 中 , AAE mE i, 
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in, ig 表示 ， 则 这 三 个 瞬时 值 电流 构成 一 个 定子 电流 空间 矢量 ， 用 7。 表示 。 


oe oe ee” es | ce 2 
I= Zant ty tle) = Zia tain + ic) (8-3 ) 








电流 空间 矢量 在 复 平面 上 的 表示 如 图 82 所 示 。  、 Kim 
一 般 说 来 ， 电 流 空间 矢量 的 长 度 和 位 置 都 是 随时 间 “ 
变化 的 。 

当 三 相 电 流 没有 零 序 分 量 ( 当 电 动机 三 相 绕组 
是 星 形 联结 而 中 点 不 外 接 时 ， 此 条 件 可 以 满足 )， 
Bi, +i, tic =O 时 ， 可 以 证 明 ， 磁 势 空 间 矢 量 Fs 
EA, B, C 三 相 轴 线 上 的 投影 正好 等 于 六 Pp, 
Fo, HJERTE, MEP i, ip, ic 之 间 出 现 了 一 一 对 YY 
应 关系 。 即 任意 一 组 的 i， 六，ic 将 唯一 地 确定 一 图 8-2 ”电流 空间 矢量 
个 磁 势 空间 矢量 F, AZIR. KRE, ZEIZ 
相 电 流 没 有 零 序 分 量 时 的 约束 条 件 i tip tic =0， 一 组 电流 六， 总 ，i 只 包含 两 个 独立 变 
量 ， 而 一 个 空间 矢量 到 也 包含 着 实 部 的 和 虚 部 两 个 独立 变量 ， 所 以 两 者 之 间 有 可 能 一 一 对 
应 。 

将 三 相 电动 机 中 各 相 的 物理 量 综合 起 来 ， 用 空间 矢量 表达 ， 具 有 下 列 优点 : 

1) 电流 空间 矢量 代表 三 相合 成 电流 ， 磁 链 空间 矢量 代表 三 相合 成 磁场 ， 直 观 且 形象 化 ; 

2) 由 某 物理 量 的 空间 矢量 在 某 一 相 绕 组 轴线 上 的 投影 ， 可 得 到 该 物理 量 的 瞬时 值 。 所 
以 ,根据 空间 矢量 的 变化 情况 ， 很 容易 求 出 各 相 有 关 物 理 量 的 时 间 波 形 图 ; 

3) 可 以 证 明 ， 电 动机 的 转 矩 正比 于 磁 链 空间 矢量 和 电流 空间 矢量 的 矢 积 ， 所 以 在 空间 
矢量 图 上 能 直观 地 确定 电动 机 转 矩 的 大 小 和 方向 ; 

4) 由 于 引入 空间 矢量 概念 时 并 不 要 求 各 相 的 物理 量 随时 间作 正弦 变化 ， 因 此 ， 变 流 装 
置 答 向 电动 机 绕组 的 非 正 蓄 电 流 或 非 正弦 电压 ， 也 可 以 用 空间 矢量 加 以 分 析 。 


8.1.2 感应 电动 机 矢量 变换 控制 


1971 年 德国 学 者 F. Blaschke 提出 了 感应 电动 机 磁场 定向 型 矢量 变换 控制 理论 ， 实 现 了 
能 找 出 两 个 分 别 决 定 磁 通 和 电磁 转 矩 的 独立 控制 量 ， 并 且 求 出 了 这 两 个 控制 量 与 直接 测量 及 
控制 的 定子 坐标 变量 之 间 的 关系 式 ， 使 得 感应 电动 机 的 电磁 转 和 矩 能 像 直流 电动 机 一 样 解 耦 独 
立 控 制 。 因 此 在 感应 电动 机 的 动态 分 析 和 控制 中 ， 坐 标 系 统 的 选择 是 关键 ,采用 合适 的 坐标 
系统 能 使 问题 简化 ， 控 制 简单 ， 并 准确 获得 良好 的 动态 性 能 ”。 

感应 电动 机 矢量 变换 控制 就 是 将 用 静止 坐标 系 所 表示 的 电动 机 矢量 变换 到 磁场 定向 的 坐 
标 轴 系 ， 这 里 包括 转子 磁场 、 定 子 人 磁场、 气 际 磁场 。 三 相 电 流 ( 可 以 是 转子 电流 或 定子 电 
流 ) 经 过 由 三 相 静 止 坐标 系 到 两 相 垂 直 静 止 坐标 系 ， 再 由 两 相 垂直 静止 坐标 系 到 两 相 旋转 坐 
标 系 的 变换 ， 并 使 m 轴 沿 着 磁 链 的 方向 ， 则 感应 电动 机 就 变 成 了 由 励磁 电流 分 量 i APE 
电流 分 量 i 分 开 控制 的 直流 电动 机 。 按 照 直 流 电动 机 的 控制 方法 ， 求 得 控制 量 后 ， 再 经 过 坐 
标 反 变 换 ， 就 能 控制 感应 电动 机 ， 对 感应 电动 机 的 控制 转 为 对 磁 链 参照 系 下 的 直流 电动 机 的 
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控制 。 

矢量 变换 是 一 组 和 矩阵 表达 式 。 矢 量变 换 包 括 三 相 静 止 坐标 系 到 两 相 静 止 坐标 系 的 变换 
( 称 Clarke 变换 或 3/2 变换 ) ， 两 相 静 止 坐标 系 到 两 相 旋转 坐标 系 的 变换 ( 称 Park 变换 ) ， 以 
及 直角 坐标 到 极 坐标 的 变换 ( 称 K/P 变换 ) 。 

图 8-3 所 示 为 三 相 静 止 坐 标 到 两 相 静 止 坐标 的 变换 ， 
图 中 的 三 相 坐 标 系 A-B-C 变换 到 两 相 坐 标 系 w-B。 

从 矢量 合成 的 角度 推导 ， 一 个 矢量 从 一 个 三 相 坐标 系 
A-B-C 变换 到 两 相 坐 标 系 a-B 也 称 为 3/2 变换 ， 反 之 为 2/3 
变换 。 

现 以 电流 矢量 的 变换 来 简单 说 明 其 变换 关系 式 ， 矢 量 
7 在 三 相 坐 标 系 下 可 表示 为 了 =i,+ais t+ cic, Ea, BB 
相 坐标 轴 系 下 可 表示 为 了 = +jis。 根 据 坐 标 变换 保持 矢 
量 了 不 变 的 原理 ， 在 矢量 图 中 ， 可 以 得 到 沿 a 轴 分 解 的 分 人 





























1 1 ‘ . 3, 
HE Ly = 一 っ = っ ’ 以 及 党 B 細分 解 的 分 量 lg -Ëi = 图 8-3 三 相 静 止 坐标 系 到 两 相 








静止 坐标 系 的 变换 
は 2 | n pe 
っ ce 写成 矩阵 形式 为 
2 1 1 
i z a Faa 
ee l 
z ; 4 
H lea D ak 90 
B 3. C 
则 3/2 变换 矩阵 C3, 为 
O. R. 
3| 3 3 
Cs a i i (8-5) 
0 
B B 
如 果 三 相 平衡 ， 即 六 +z ti, =0， 则 可 以 推出 
9 
la = 2 la 
(8-6) 


则 简化 后 的 矩阵 形式 为 


i en 

















由 式 (8-7) 可 以 看 出 ,i POMEL ia WIESA, 这 是 保证 变换 前 后 合成 矢量 幅 值 不 变 
的 前 提 ， 即 三 相 和 两 相 产 生 的 合成 电流 矢量 相同 。 同 理 ， 可 以 推导 出 道 变换 为 
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1 0 
ta 2 1 B 7 
| 图 
iJ | 1 8 
2 2 
式 中 ， 从 两 相 静 止 a-B 坐标 系 变 换 到 三 相 静 止 A-B-C 坐标 系 ，273 变换 矩阵 CL, 
1 0 
shook 6 
(ome = 2 2 (8-9) 
1 
2 


图 84 所 示 为 两 种 坐标 系 ，a-B 为 两 相 静 
IRZ, m-t 为 两 相 旋转 坐标 系 。 如 果 让 m- 
t 坐标 以 同步 角速度 w, 旋转 ， 则 产生 的 磁 动 
势 与 e-B 坐标 系 等 效 。m 轴 和 a MRKA y 
( 亦 即 m 轴 和 A 轴 夹 角 ) 是 一 个 变量 ， 随 负 
载 、 转 速 而 变 ， 不 同时 刻 有 不 同 的 值 。 

由 此 得 变换 关系 式 为 

lm cosy sinylfria 
Pal E 


-siny cosy 














ST 





图 84 mt HAS a-p 轴 系 关系 图 


由 图 8-4 可 见 ， 从 两 相 静 止 坐 标 系 a-B 到 
磁 链 坐标 系 m-t 的 夹 角 即 磁 链 位 置 角 9,，a-B 坐标 系 变换 到 m-t 坐标 系 的 变换 矩阵 为 


COS sin 
Ciya = | "| (8-11) 
-siny cosy 
同 理 , AY DASE HY Be Ae 
cos ー sin 
Caas =| $ * | (8-12) 
siny cosy 





如 果 直 接 由 三 相 坐标 系 直 接 变换 到 旋转 坐标 系 ， 则 将 旋转 变换 式 (8-12 ) EK (8-5 ) 相本 ， 
得 到 A-B-C 坐标 系 直接 变换 到 旋转 坐标 系 m-t 的 变换 矩阵 
cosy cos(yー120?) cos(y+120?) 
2| -siny -sin(y-120°) -sin(y +120°) 





Cs =a 1 1 ( 8-13 ) 
2 2 A 
同 理 求 得 m-t 轴 系 变换 到 A-B-C Hh ARM REE 
cosy ー siny 1 
C =| cos(yー120?)  -sin(y-120°) 1 (8-14) 


cos(y +120°) -sin(y+120°) 1 
在 计算 磁 动 势 时 ， 采 用 极 坐 标 系 能 简化 计算 和 分 析 。 设 合成 矢量 与 m 轴 的 夹 角 为 p， 则 
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直角 坐标 与 极 坐标 其 变换 关系 式 
i = Vi +i (8-15) 


Li 一 > , 
g=arctan 一 ， 由 于 tang 幅 值 变化 过 大 ， 因 此 常用 公式 =2arctan 


m Ls m 


由 于 在 理论 分 析 和 实际 运行 过 程 中 ， 双 僻 交 流感 应 电动 机 的 磁 链 、 电 压 、 电 流 等 物理 量 
都 是 以 其 基 波 形式 来 进行 研究 的 ， 并 且 电 动机 内 部 绕组 采用 了 分 布 、 短 距 、 和 斜 槽 等 措施 ， 其 
气 隙 磁场 具有 很 小 的 谐 波 ， 因 此 将 其 视 为 “理想 感应 电动 机 ”来 进行 研究 和 分 析 ， 如 图 8-5 所 
示 。“ 理想 绕 线 式 感应 电动 机 ”的 假定 如 下 : 

1) 忽略 铁 磁 饱和 、 磁 沾 及 涡流 等 的 影响 ， 不 计 铁 心 c 
和 导线 的 集 肤 效应 ; 

2) PARE, CRIA, AMET. PTA 
的 影响 ， 认 为 定子 、 转 子 都 有 光滑 的 表面 ; 

3) 忽略 温度 变化 对 于 电动 机 有 关 参 数 的 影响 ; 

4) 定 、 转 子 三 相 绕 组 对 称 ， 每 相 绕 组 均 在 气 际 中 产 
生 正 弦 形 分 布 的 磁 通 密度 。 

在 三 相 静 止 坐标 系 下 ， 有 异步 电动 机 的 定子 三 相对 称 
HA, B, C 在 空间 是 固定 的 ,4 相 绕 组 的 中 轴线 是 该 
坐标 系 的 参考 坐标 轴 ， 转 子 三 相对 称 绕组 a, b, c 以 转 图 8-5” 绕 线 式 三 相 感应 
子 角 速度 w, 逆 时 针 旋 转 ， 转 子 a 轴 和 定子 4 MRAN 9。 电动 机 示意 图 
并 规定 各 绕组 电压 、 电 流 、 磁 链 的 正方 向 符合 电动 机 惯例 和 右手 螺旋 定 则 。 这 时 感应 电动 机 
的 数学 模型 由 电压 方程 、 磁 链 方程 、 转 矩 方程 和 运动 方程 组 成 ” 。 

(1) 三 相 坐 标 系 下 的 电压 方程 。 

三 相 定子 电压 平衡 方程 为 


i 





(8-16) 

















us =1yRy + py 
に we (8-17) 
uc =icRe +pWe 

相应 的 三 相 转子 折算 到 定子 侧 后 的 电压 方程 为 

u, =R, + pp, 


Up = iR, +PP, (8-18) 











u, E LR, + py. 


式 中 ， Uy, Ug, Uc, Ua, Up, We 分 别 为 定 、 转子 各 相 电 压 ; Las Ig, Ic, bay ip, le 分 别 为 定 、 
转子 各 相 电 流 ; WR, R 分 别 为 定 、 转 子 相 电阻 ， 由 于 定 、 转 子 绕组 对 称 ， 因 此 R, =R; = 


en 
Ro =R,, R, =R, =R, =R,; Pas ws， Pes Was Yrs 。 为 各 绕组 磁 链 ; P= AAR F 


写成 矩阵 形式 为 [U] = [A][7] +p[g] 
即 
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UA R 0 0 0 0 OJT Wa 
Up 0 R 0 0 0 0 Wp 
u 0 0 R 0 0 OF & a 
C _ s ( ge Pe (8-19) 
u, 0 0 0 R O OF i, み 。 
Uy, 0 0 0 0 R OJ; Ws, 
u, 0 0 0 0 0 Ri P. 
式 中 ， = [uA Up Uc U, Up U Le 


| 
SS 
ma 。 ーー 


] =[& lp tc h Wy by i 
[R] =diag[ R, R, R, R, R, RJ" 
[y= Ye Ye pa Wy pl 
其 中 对 角 线 元 素 Liis Leg, Lec, Eis Ly» LÆKKA RRAK 自 感 ， 其 余 各 项 则 是 绕组 间 的 
互感 。 
(2) 磁 链 方程 。 





[ ゅ ] =[LIL7] 
其 中 每 个 绕组 的 磁 链 是 它 本 身 的 自 感 磁 链 和 其 他 绕组 对 它 的 互感 磁 链 之 和 。 
以 定子 为 例 ， 每 相 绕 组 的 全 自 感 系数 包括 两 部 分 ,一 部 分 是 只 与 该 绕 阻 交 链 但 不 穿 过 气 
隙 的 漏 感 Cs ， 还 有 一 部 分 是 穿 过 气 院 且 与 其 自身 绕组 相交 链 的 主 磁 链 对 应 的 主 电感 La, 
此 定子 每 相 全 电感 





























Laa = Lpr = Lee =La + Les 
同 理 ， 转 子 每 相 全 电感 
La =Ly =Le = Lm + Ls 
两 相 绕 组 之 间 只 有 互感 。 定 子 和 转子 的 三 相 彼此 之 间 位 置 都 是 固定 的 ， 它 们 的 轴线 在 空间 
的 相位 差 是 +120°*， 假 定 气 际 磁 通 为 正弦 分 布 的 条 件 下 ， 互 感 值 为 Lacos120° = L,,cos( -120?) 
1 


= J 二 
2 sh TE 














(8-20) 














由 于 定子 任 一 相 与 转子 任 一 相 之 间 的 位 置 是 变化 的 ， 因 此 互感 是 转子 位 置 角 9 的 函数 
Li = Lay = Lp, ニル = Le. = Loe = Ly, 0080 
区 Shi. Sly Sehgal SLL eos! +120") (8-21) 
ky jl = Lp She テル た eos( ひ 1208) 
式 中 , 代表 定子 側 , 7 代表 转子 侧 ; 9 为 转子 轴 和 定子 轴 夹 角 。 
(3) 运动 方程 。 
电动 机 的 机 械 运动 方程 为 


T, =T, + 二 一 (8-22) 
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AP, T, 为 电动 机 额定 输出 转 矩 ; Ts J 为 电动 机 转轴 上 总 的 转动 惯量 ; ヵ 。 为 
电动 机 极 对 数 。 
(4) 电磁 转 矩 方程 。 
根据 机 电能 量 转 换 的 理论 可 知 ， 极 对 数 为 n, 的 感应 电动 机 电磁 转 矩 7。 处理 后 的 表达 
R N 
T, =n, L, (igi, + igi, + ici, sind + (igi, +ipic + ici, )sin(0 + 120°) 
+ (igi, tipi, + ici, )sin(@ - 120°) ] (8-23) 


8.2 ”大 型 起 重 机 控制 系统 


交流 电动 机 的 气 际 磁 链 定向 控制 框图 如 图 8-6 所 示 ， 控 制 系统 由 以 下 几 部 分 组 成 : 速度 
环 控 制 器 、 电 流 环 交 、 直 流 调 节 器 、 电 压 前 饥 、 电 压 模 型 、 坐 标 变换 、 转 子 励磁 控制 、 
SVPWM 模块 和 道 变 模块 等 。 给 定 的 速度 指令 信号 n 与 检测 到 的 转子 速度 信号 比较 ， 经 速 
度 控制 器 的 调节 输出 7 了 轴 电 流 控制 器 给 定 信 号 总 ，M 轴 电 流 控制 器 的 给 定 信号 总 设 定 值 为 
零 。 电 流 采 样 得 到 的 三 相 定 子 电流 通过 3/2 变换 和 旋转 变换 后 分 别 为 戏 轴 和 了 轴 电 流 调节 
器 的 反馈 输入 。 电 流 的 给 定 和 反馈 相 比 较 ， 经 过 电流 交 、 直 流 控制 器 调节 ， 并 与 前 馈 单 元 输 
出 电压 相 加 作为 三 电 平 SVPWM 的 输入 信和 号。 三 相 输 入 信号 调制 SVPWM 模块 输出 12 路 
PWM 波 ， 产 生 频 率 和 幅 值 可 变 的 电动 机 所 需 供电 的 三 相 正弦 电压 。 
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图 8-6 交流 电动 机 矢量 控制 系统 框图 





针对 异步 电动 机 应 用 的 高 性 能 低压 两 电 平 交 一 直 一 交 变 频 器 (位 能 型 负载 、 四 象限 )， 
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整个 控制 系统 主要 由 多 个 核心 控制 部、 一 个 高 性 能 工控 机 及 显示 器 构成 。 它 们 之 间 通 过 通用 
现场 总 线 通信 协议 构成 以 工控 机 为 主 站 ， 其 他 设备 为 从 站 的 以 太 网 结构 。 倍 福 工控 机 实现 对 
所 有 核心 控制 器 的 编程 与 控制 ， 对 它们 的 信息 进行 采集 和 汇总 ， 实 现 对 多 台电 动机 之 间 的 逻 
辑 控 制 和 协同 控制 ， 并 实现 对 核心 控制 器 的 调试 、 监 控 功 能 。 此 外 工控 机 可 以 实现 与 外 部 自 
动 化 系统 的 以 大 网 连接 。 黑 心 控制 器 是 自主 开发 的 电力 电子 控制 器 ， 用 于 实现 核心 控制 算 
法 。 每 个 核心 控制 器 可 以 控制 一 人 台 整 流 回 馈 变 流 装置 和 一 个 逆 变 装置 ， 并 通过 工业 以 太 网 卡 
实现 网 络 通信 。 除 供电 电源 与 网 络 接口 外 ， 核 心 控制 器 与 外 部 设备 的 连接 全 部 采用 光纤 通 
言 ， 提 高 了 系统 的 抗 干扰 能 力 ， 并 且 增 强 了 可 靠 性 。 用 于 数据 采集 的 接口 模块 ， 包 括 电 压 电 
流 采 样 、 数 字 输 入 、 模 拟 输入 、 编 码 器 输入 等 均 通过 光纤 将 信息 传输 至 核心 控制 器， 其 发 出 
的 指令 和 变量 也 通过 光纤 传递 给 数字 和 输出、 模拟 输出 等 模块 。 核 心 控 制品 通过 光纤 与 变频 器 
的 功率 接口 模块 连接 ,将 PWM 脉冲 指令 传递 给 变频 器 的 功率 模块 。 功 率 模块 的 电压 电流 、 
电动 机 转速 反馈 等 信号 经 过 采集 和 转换 后 也 经 光纤 反馈 给 核心 控制 器 。 监 控 系 统 或 显示 屏 用 
于 实现 对 整个 系统 的 运行 状态 进行 监控 ， 显 示 各 种 运行 变量 和 故 隐 信息 。 控 制 器 主要 由 电源 
供电 模块 、 核 心 控制 模块 、 光 纤 通 信 模 块 及 网 络 通信 模块 等 构成 。 电 源 供电 模块 为 控制 器 各 
种 元 件 提供 不 同 电源 供电 。 核 心 控 制 模块 包括 执行 主要 控制 算法 的 数字 信和 号 处 理 器 及 实现 大 
量 数据 处 理 和 逮 辑 处 理 的 可 编程 门 阵 列 ， 且 二 者 之 间 通 过 并 行 的 数据 地 址 总 线 进行 数据 通 
信 ， 并 通过 中 断 的 形式 对 执行 动作 的 进程 进行 控制 。 光 纤 通 信和 模块 实现 电信 号 与 光 信号 的 相 
互 转换 ， 使 核心 控制 器 与 外 部 的 数据 交换 和 信息 交流 全 部 通过 光纤 来 实现 。 网 络 通 信和 模块 采 
用 工业 以 太 网 卡 ， 使 核心 控制 器 可 以 向 网 络 传输 数据 ， 也 可 以 从 网 络 接收 数据 。 接 口 模块 根 
据 其 功能 主要 分 为 数字 输入 、 数 字 输 出 、 模 拟 输入 、 模 拟 输出 、 采 样 模 块 、 编 码 絮 输入 等 ， 
采用 自主 研发 设计 的 功能 模块 ， 用 以 实现 外 部 设备 与 核心 控制 器 之 间 的 数据 交换 。 根 据 实际 
需要 ， 可 以 自由 灵活 配置 。 

(1) 数字 输入 模块 。 每 个 数字 输入 模块 可 同时 实现 多 路 开关 量 输入 ， 用 于 各 种 开关 型 器 
件 的 状态 采集 。 该 模块 通过 光纤 将 采集 到 的 开关 量 基于 自行 开发 的 通信 协议 传输 给 核心 控制 
器 。 除 了 多 路 开关 状态 指示 灯 之 外 ， 该 模块 还 具有 电源 状态 和 信号 处理 状态 两 个 状态 指示 
灯 。 

(2) 数字 输出 模块 。 每 个 数字 输出 模块 可 以 同时 实现 多 路 开关 量 输 出 ， 用 于 输出 各 种 开 
关 型 控制 信号 或 状态 信号 。 核 心 控制 器 通过 光纤 将 开关 量 输出 传输 给 该 模块 。 同 样 ， 除 多 路 
开关 输出 状态 指示 灯 外 ， 该 模块 还 具有 一 个 电源 指示 灯 和 一 个 信号 处 理 状态 指示 灯 。 

(3) 模拟 输入 模块 。 每 个 模拟 输入 模块 可 以 同时 实现 多 路 模拟 信号 的 输入 ， 接 线 灵活 ， 
输入 信号 可 以 是 电压 信号 、 电 流 信 号 或 热电 偶 信 号 。 通 过 光纤 将 信息 传输 给 核心 控制 器 。 具 
有 电源 指示 灯 和 信号 处 理 状 态 指 示 灯 。 

(4) 模拟 输出 模块 。 每 个 模拟 输出 模块 可 以 同时 实现 多 路 模拟 信号 的 输出 ， 可 以 输出 电 
压 信号 或 者 电流 信和 号。 核心 控制 絮 通 过 一 路 光纤 将 模拟 输出 信号 传递 给 该 接口 模块 。 该 模块 
同样 具有 电源 指示 灯 和 信号 处 理 状态 指示 灯 。 

采用 高 性 能 工控 机 作为 工业 以 太 网 控制 网 的 主 站 ， 与 网 络 中 的 各 核心 控制 器 (作为 从 
站 ) 、 0 模块 等 构成 主 从 站 网 络 模式 。 工 控 机 的 主要 作用 是 完成 对 不 同 核心 控制 器 的 编程 
控制 ， 包 括 工 作 模 式 的 选择 、 参 数 的 设置 及 设备 运行 的 监控 等 。 核 心 控 制 絮 作为 变频 絮 控 制 
系统 的 核心 ， 需 实现 以 下 软件 功能 :变频 器 系统 的 控制 逻辑 ; 变频 絮 控 制 所 需 电压 ， 电 流 信 
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号 的 A-D 采样 ; 速度 编码 器 的 脉冲 信号 的 处 理 ， 获 取 转 速 信息 ; 系统 保护 功能 ， 包 括 过 从 
电压 保护 、 过 电流 保护 ， 以 及 因 其 他 各 类 故障 引起 的 保护 ;核心 控制 算法 ， 实 现 异 步 电机 的 
三 种 控制 方式 ， 即 V/F 开 环 控制 方式 、 无 速度 编码 器 的 频率 闭环 矢量 控制 方式 、 有 速度 编 
码 髓 的 速度 闭环 矢量 控制 方式 ; 不 带 速度 编码 右 的 VAF 开 环 控制 适用 于 简单 应 用 场合 和 成 
组 传动 高 水 平 同 步 运 转 ， 调 速 范围 为 1: 10。 磁 场 定 向 矢量 控制 用 于 高 动态 性 能 传动 系统 的 
频率 闭环 控制 (无 编码 器 ) 和 转速 财 环 控制 (有 编码 器 ) 。 实 现 准确 地 调节 转 矩 电流 分 量 和 磁 
通电 流 分 量 ， 其 调节 频率 为 2. 5kHz， 在 调 速 范围 1:100 以 内 。 具 有 外 部 附加 力矩 输入 接点 ， 
外 部 电流 给 定 输入 接点 ， 外 部 力矩 给 定 输入 接点 ; 具有 力矩 给 定 输出 接点 ， 电 流 给 定 输 出 接 
点 ; 具有 系统 自动 辨识 和 优化 功能 和 抱 闸 控制 功能 。PWM 脉冲 产生 模块 根据 由 控制 算法 得 
出 的 控制 指令 产生 相应 的 脉冲 指令 ; 自由 功能 模块 配备 具有 不 同 功能 的 软件 模块 ， 分 为 信号 
模块 、 信 和 号 转换 模块 、 计 时 器 模块 、 逻 辑 模 块 、 计 算 模 块 、 控 制 模块 等 ， 使 传动 系统 能 够 适 
用 于 各 种 不 同 的 使 用 场合 ; 可 编程 的 输入 输出 模块 配置 有 可 编程 的 输入 输出 接口 ， 即 多 个 可 
编程 开关 量 输入 点 、 多 个 可 编程 开关 量 输 出 点 、 多 个 可 编程 模拟 量 输入 点 及 多 个 可 编程 模拟 
量 输出 点 的 设置 ; 网 络 通信 功能 模块 配备 有 开发 基于 工业 以 太 网 卡 的 通信 程序 ， 用 以 实现 核 
心 控 制 与 工控 机 的 网 络 通 信 ; 故障 记录 功能 有 核心 控制 器 作为 控制 系统 的 核心 ， 需 对 发 生 的 
所 有 故障 尤其 是 重要 故障 进行 记录 ， 并 通过 本 地 存储 或 远程 传输 存储 的 方式 进行 保留 ， 以 备 
分 析 故 障 原 因 。 

系统 的 性 能 指标 如 下 : 触发 脉冲 的 最 小 脉冲 频率 为 1. 7kHz， 设 定 频 率 为 2. 5kHz， 最 大 
设 定 频率 为 16kHz; 电流 控制 性 能 指标 : 基本 负载 电流 为 0.91 x 额定 输出 电流 ; 短 时 电流 为 
1.36 x 额定 输出 电流 (对 于 过 载 时 间 60s); 过 载 周期 时 间 为 300s; 额定 输出 频率 为 10 ~ 
60Hz; 输出 频率 范围 为 0 ~ 75Hz; 变频 器 过 载 能 力 为 200% ，lmin; 静态 速度 精度 为 < 
0.01%; 速度 控制 响应 时 间 为 110ms; 电流 控制 响应 时 间 <8ms; 动态 指标 为 0. 25% +s; 装置 
额定 效率 >=97% ; 输入 谐 波 畸 变 率 <5% ; 输出 谐 波 畸 变 率 <5% 。 速 度 控制 性 能 指标 见 表 8-1。 

表 8-1 速度 控制 性 能 指标 






























































































































































运行 模式 压 频 比 特性 闭环 频率 控制 闭环 速度 控制 
数字 式 给 定 分 辩 率 0. 001Hz 31 位 + 标志 
模拟 式 给 定 分 辨 率 Finax/ 2048 
内 部 频率 分 辨 率 0. 001Hz 31 位 + 标志 
速度 准确 率 
在 n>10% 0. 20% 0. 10% 0.05% 

在 n<5% 1. 00% 1.00% 0.1% 

弱 磁 运行 0. 15% 0. 1% 
速度 上 升 时 间 25ms #7 n >5% 20ms 
恒定 磁场 范围 <2.5% 若 n>5% <2.5% 若 n>1% 

弱 磁 范围 <5% <5% 

转 和 矩 上 升 时 间 =5ms #7 n >5% 约 Sms 

EE KY <2% <2% 
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8.3 ”大 型 起 重 机 安全 监控 管理 信息 系统 


大 型 起 重 机 安全 监控 管理 信息 系统 是 经 典 的 信息 物理 系统 (Cyber Physical System， 
CPS)， 本 节 以 门 座 式 大 型 起 重 机 的 CPS 系统 为 例 ， 进 行 相关 的 说 明和 分 析 。 

大 型 港口 门 座 起 重 机 安全 管理 监控 系统 设计 和 实施 中 要 求 采 用 成 熟 、 先 进 的 技术 ， 系 统 
主要 性 能 指标 要 达到 国内 先进 水 准 。 以 经 济 实用 为 原则 ， 充 分 考虑 初始 一 次 性 投资 的 规模 ， 
并 使 系统 今后 运行 时 的 成 本 最 小 化 ， 达 到 较 高 的 性 价 比 。 系 统 配置 要 适合 使 用 要 求 ， 从 而 创 
造 高 效 、 安 全 、 准 确 的 环境 ， 达 到 安全 生产 的 目的 。 

项 目 遵循 总 体 设计 、 分 步 实施 的 原则 ， 整 个 系统 要 具有 较 高 的 可 扩展 性 、 安 全 性 、 可 靠 
性 和 准确 性 。 要 求 监 控 系 统 通 过 与 起 重 机 PLC 控制 系统 通信 ， 达 到 对 事件 的 快速 处 理 、 响 
应 和 存储 功能 。 

大 型 港口 门 座 起 重 机 主要 是 为 了 对 起 重 机 进行 实时 监控 管理 而 开发 的 一 套 监 控 系统 。 本 
项 目 安全 管理 系统 设计 需 考虑 如 下 子 系统 工程 ， 即 实时 状态 监控 系统 、 故 障 报 警 系 统 、 历 史 
故障 查询 系统 、 操 作 记录 查 询 系统 。 监 控 系 统 可 进行 扩展 ， 留 有 足够 的 接口 ， 以 满足 整个 监 
控 系 统 的 要 求 。 

系统 的 安全 防范 系统 的 设计 需 满足 以 下 国标 中 的 各 项 要 求 : GB/T 28264 一 2012《 起 重 机 
械 安全 监控 管理 系统 》; GB 6067. 1 一 2010《 起 重 机 械 安全 规程 第 1 部 分 : MMW); GB 
5226. 2 一 2002《 机 械 安全 机 械 电 气 设备 第 32 部 分 : 起 重 机 械 技 术 要 求 》。 门 座 式 起 重 机 安 
全 监控 管理 系统 拓扑 图 (司机 室 触 摸 屏 远 程 操作 工控 机 ) 如 图 8-7 所 示 。 
显示 本 系统 要 求 显 示 的 起 重 机 实时 信息 ， 包 括 起 重量 力矩 信息 、 环 境 风 速 信 息 、 制 动 器 
状态 信息 、 起 升 高 度 下 降 深度 信息 、 其 他 限 位 信息 等 。 工 程 浏 览 器 左 栏 中 单 击 “数据 字典 ”， 
在 数据 字典 中 新 定义 变量 ， 系 统 中 各 个 限 位 器 故障 点 接 入 PLC 均 为 干 接 点 开关 量 信 号 ， 在 
组 态 王 中 选择 开关 类 型 为 /0 离散 型 ， 连 接 设备 选择 在 前 面 所 配置 的 C200HE， 寄 存 器 选择 
IR 寄存 器 ， 地 址 对 应 PLC 梯形 图 中 的 地 址 。 读 写 类 型 选择 只 读 ， 数 据 类 型 为 位 读 取 。 按 照 
上 述 步 又 建立 开关 量 采集 点 数据 字典 。 模 拟 量 设置 : 系统 中 起 重量 传感器 、 风 速 传感器 、 幅 
度 传感器 等 接 入 PLC 模拟 量 模块 AD003 ， 均 为 模拟 量 信号 ， 在 组 态 王 中 选择 开关 类 型 为 IO 
实数 型 ， 连 接 设备 选择 在 前 面 所 配置 的 C200HE， 寄 存 器 选择 DM 寄存 器 ， 地 址 对 应 采集 点 
PLC 梯形 图 中 采集 数据 的 存储 区 域 。 读 写 类 型 选择 只 读 ， 数 据 类 型 为 USHORT。AD003 模块 
的 分 辩 率 为 1/4000， 将 变量 最 小 原始 值 设置 为 0， 最 大 原始 值 设 置 为 4000。 最 小 值 和 最 大 值 
分 别 表 示 实 际 需 要 测量 的 量程 ， 按 照 如 上 步骤 建立 模拟 量 采 集 点 数据 字典 。 现 场 环境 下 风速 
仪 通过 RS232 串口 与 工控 机 进行 通信 ， 组 态 王 中 提供 有 串口 数据 发 送 的 驱动 ， 在 风速 仪 接 
和 人 的 串口 新 建 " 串 口 数据 发 送 ” 设 备 。 接 收 数据 的 处 理 过 程 代 码 如 下 ， 自 定义 函数 transform 
() 实 现 串 口 数据 的 读 取 和 显示 。 

1) 首先 提取 串口 数据 中 的 有 效 数据 ， 即 风速 字符 。 

\\ 本 站 点 \ 提 取 的 风速 字符 = SrMid(\\ 本 站 点 \ 接 收 的 风速 字符 串 ,6 ,1) ; 

2) 对 提取 的 字符 进行 处 理 。StrASCI 返回 某 一 指定 的 字符 串 变 量 首 字 符 的 ASCI 值 ， 减 
去 48 即 可 得 到 整数 值 。 代 码 如 下 : 

\\ 本 站 点 \ 风 速 字符 整数 值 =SrASCII( \\ 本 站 点 \ 提 取 的 风速 字符 ) - 48; 
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主 起 升 高 度 编码 器 ”大 车 行程 编码 器 





图 8-7“ 门 座 式 起 重 机 安全 监控 管理 系统 拓扑 图 (司机 室 触摸 屏 远程 操作 工控 机 ) 


3) 对 获得 的 十 六 进 制 整数 进行 运算 ， 代 码 如 下 : 


float templ ; 
if(\\ 本 站 点 \ 风 速 字符 整数 值 > =0&&A\\ 本 站 点 \ 风 速 字 符 整 数值 < =9) {templ = \ 本 


站 点 \ 风 速 字 符 整 数值 * 16 * 16; | 
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else | \\ 本 站 点 \ 风 速 字 符 整 数值 =\\ 本 站 点 \ 风 速 字 符 整 数值 -7;templ = \\ ASI A \ UE 
字符 整数 值 * 16 * 16; | 

\\ 本 站 点 \ 提 取 的 风速 字符 = StMid(\\ 本 站 点 \ 接 收 的 风速 字符 串 ,7 ,1) : 

\\ 本 站 点 \ 风 速 字符 整数 值 =SrASCII( \\ 本 站 点 \ 提 取 的 风速 字符 ) -48: 

float temp2 ; 

if( \\ 本 站 点 \ 风 速 字符 整数 值 > =0&&\\ 本 站 点 \ 风 速 字符 整数 值 < = 9) | temp2 = \ 本 
站 点 \ 风 速 字符 整数 值 * 16 ; | 

else | \\ 本 站 点 \ 风 速 字 符 整 数值 = \\ 本 站 点 \ 风 速 字 符 整 数值 -7;temp2 =\\ 本 站 点 \ 风 速 
字符 整数 值 * 16; | 

\\ 本 站 点 \ 提 取 的 风速 字符 = SrMid(\\ 本 站 点 \ 接 收 的 风速 字符 串 ,8 ,1); 

\\ 本 站 点 \ 风 速 字符 整数 值 = SrASCII( \\ 本 站 点 \ 提 取 的 风速 字符 ) -48 ; 

float temp3 ; 

if(\\ 本 站 点 \ 风 速 字符 整数 值 > =0&&\\ 本 站 点 \ 风 速 字 符 整 数值 < = 9) | temp3 = \\ AS 
站 点 \ 风 速 字符 整数 值 ; | 

else | \\ 本 站 点 \ 风 速 字 符 整 数值 =\\ 本 站 点 \ 风 速 字 符 整 数值 -7; 

temp3 =\\ 本 站 点 \ 风 速 字 符 整 数值 ; | 

\\ 本 站 点 \ 风 速 值 = (templ +temp2 +temp3) * 0.1: 

实时 监控 画面 采集 源 包括 的 部 分 见 表 8-2。 

表 8-2 系统 数据 采集 源 





































































































序号 数据 采集 源 传感器 类 型 
1 起 重量 限制 器 开关 信号 
2 力矩 限制 器 开关 信和 号 
3 起 升 高 度 下 降 深度 限制 器 凸轮 限 位 开关 
4 运行 行程 限制 器 模拟 值 显示 
5 幅度 限制 器 限 位 开关 信和 号 
6 门限 位 限 位 开关 
I 机 构 之 间 运 行 连 锁 PLC 程序 运行 连锁 
8 抗 风 防 滑 装置 行走 锚 定 限 位 开关 
9 风速 仪 装置 风速 仪 RS-232 通信 方式 
10 同一 轨道 防 碰撞 装置 行走 防 碰撞 限 位 开关 
11 超速 保护 装置 模拟 值 显示 速度 
12 供电 电缆 安全 限 位 限 位 开关 
13 起 升 机 构 制 动 器 制动器 限 位 开关 











TE: 因 现场 设备 为 360 度 全 回转 运行， 所 以 不 设置 回转 锁定 装置 。 





























系统 数据 采集 源 主要 分 成 两 类 ， 一 类 是 通过 PLC 采集 ， 另 一 类 是 风速 仪 通过 串口 RS- 
232 直接 进入 工控 机 。PLC 无 源 开关 量 信号 主要 由 C200HE 系列 PLC 的 IA222 开关 数字 量 模 
块 采集 。 开 关 量 传感器 开关 信和 号 直接 连 人 PLC 的 IA222 ik, PLC 模拟 量 信号 主要 由 
C200HE 系列 PLC 的 AD003 模拟 量 模块 采集 。 模 拟 量 传感器 开关 信和 号 直接 连 和 人 PLC 的 
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AD003 模块 。 系 统 可 对 所 采集 的 数据 源 进 行 实时 信息 处 理 ， 系 统 可 以 实时 监控 PLC 米 集 模 
块 的 采集 量 ， 对 表 中 监控 的 参数 进行 实时 显示 。 对 表 中 起 重 机 运行 状态 及 故障 信息 进行 实时 
记录 ， 系 统 可 设置 超 限 监视 的 上 下 限 ， 进 行 超 限 监视 和 报警 处 理 ， 如 超 上 、 下 限 报警 ， 报 警 
方式 采用 声音 和 画面 同时 报警 ， 显 示 报 警 画面 、 声 音 、 报 警 灯 变 红色 ; 报警 确认 可 以 关闭 报 
警 声音 和 将 报警 灯 复 位 。 运 行 数 据 统计 和 计算 ， 对 历史 报警 可 以 进行 查询 ， 方 便 管理 。 

工作 循环 记录 采用 主 、 副 起 升 机 重量 记录 ; 起 始 和 终止 时 间 ; 工作 时 长 ; 系统 可 以 对 起 
重 机 累计 工作 时 间 进 行 记录 ， 当 起 重 机 左右 手柄 都 不 在 零 位 ， 即 处 于 运行 状态 时 ， 记 录 累 积 
载荷 时 间 ; 对 操作 员 的 操作 进行 记录 ， 可 以 记录 操作 手柄 的 操作 状况 ， 包 括 起 始 时 间 、 终 目 
时 间 、 操 作 名 等 信息 ， 方 便 事后 故障 分 析 和 认定 。 
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